欧美在线观看视频网站,亚洲熟妇色自偷自拍另类,啪啪伊人网,中文字幕第13亚洲另类,中文成人久久久久影院免费观看 ,精品人妻人人做人人爽,亚洲a视频

一種基于視覺的旋翼無人機三維目標定位方法與流程

文檔序號:11822328閱讀:來源:國知局

技術特征:

1.一種基于視覺的旋翼無人機三維目標定位方法,其特征在于,包括以下步驟:

步驟一、利用搭載在無人機上的攝像機拍攝圖像,并將圖像回傳到地面站;

步驟二、從回傳的圖像中選擇具有清晰輪廓的靜態(tài)物體作為標志物,并對標志物進行視覺識別;

步驟三、利用視覺識別的結(jié)果對標志物進行多點視覺測量,利用雙目視覺模型計算無人機相對于標志物的高度,根據(jù)相對高度運用線性回歸的方法計算航向偏差;

步驟四、選擇攝像機視野里的任一目標,利用航向偏差得到無人機的真實航向,進而實現(xiàn)對目標的三維精確定位。

2.如權利要求1所述的一種基于視覺的旋翼無人機三維目標定位方法,其特征在于,步驟三的具體過程如下:

步驟3.1、利用視覺識別的結(jié)果對標志物進行多點視覺測量,得到N點測量值,所述測量值包括無人機拍攝點在慣性參考系{I}的位置姿態(tài)(ψ111)…,(ψNNN),標志物在圖像中像素位置其中,ψiii分別為方位角,俯仰角和橫滾角,i代表第i個測量點,i=1,2,...N;

步驟3.2、設基線距的閾值為Dpt,當無人機在視覺測量的任意兩個點之間的距離T≥Dpt,則選取這兩個點的測量值,

其中,

<mrow> <msub> <mi>D</mi> <mrow> <mi>p</mi> <mi>t</mi> </mrow> </msub> <mo>=</mo> <mi>int</mi> <mrow> <mo>(</mo> <mfrac> <mrow> <mi>N</mi> <mo>+</mo> <mn>1</mn> </mrow> <mn>2</mn> </mfrac> <mo>)</mo> </mrow> <mo>*</mo> <mfrac> <mi>V</mi> <msub> <mi>f</mi> <mrow> <mi>G</mi> <mi>P</mi> <mi>S</mi> </mrow> </msub> </mfrac> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow>

V為無人機的飛行速度,fGPS為GPS的更新頻率;

把先視覺測量的圖像作為左視圖L,后視覺測量的圖像作為右視圖R,構(gòu)成雙目視覺模型,無人機相對于標志物的高度h為

<mrow> <mi>h</mi> <mo>=</mo> <mi>f</mi> <mfrac> <mi>T</mi> <mi>d</mi> </mfrac> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>2</mn> <mo>)</mo> </mrow> </mrow>

其中,f為攝像機的內(nèi)參數(shù)焦距,無人機位置PI=[x y z]T,經(jīng)過坐標變換將PI轉(zhuǎn)換為無人機的機體坐標系{B}的位置PB=[xb yb zb]T目標點在兩幅圖像的視差d為姿態(tài)矩陣

<mrow> <msubsup> <mi>C</mi> <mi>b</mi> <mi>I</mi> </msubsup> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <mi>cos</mi> <mi>&psi;</mi> <mi>cos</mi> <mi>&theta;</mi> </mrow> </mtd> <mtd> <mrow> <mi>cos</mi> <mi>&psi;</mi> <mi>sin</mi> <mi>&theta;</mi> <mi>sin</mi> <mi>&phi;</mi> <mo>-</mo> <mi>sin</mi> <mi>&psi;</mi> <mi>cos</mi> <mi>&phi;</mi> </mrow> </mtd> <mtd> <mrow> <mi>sin</mi> <mi>&psi;</mi> <mi>sin</mi> <mi>&phi;</mi> <mo>+</mo> <mi>cos</mi> <mi>&psi;</mi> <mi>sin</mi> <mi>&theta;</mi> <mi>cos</mi> <mi>&phi;</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>sin</mi> <mi>&psi;</mi> <mi>cos</mi> <mi>&theta;</mi> </mrow> </mtd> <mtd> <mrow> <mi>cos</mi> <mi>&psi;</mi> <mi>cos</mi> <mi>&phi;</mi> <mo>+</mo> <mi>sin</mi> <mi>&psi;</mi> <mi>sin</mi> <mi>&theta;</mi> <mi>cos</mi> <mi>&phi;</mi> </mrow> </mtd> <mtd> <mrow> <mi>sin</mi> <mi>&psi;</mi> <mi>sin</mi> <mi>&theta;</mi> <mi>cos</mi> <mi>&phi;</mi> <mo>-</mo> <mi>cos</mi> <mi>&psi;</mi> <mi>sin</mi> <mi>&phi;</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>-</mo> <mi>sin</mi> <mi>&theta;</mi> </mrow> </mtd> <mtd> <mrow> <mi>sin</mi> <mi>&phi;</mi> <mi>cos</mi> <mi>&theta;</mi> </mrow> </mtd> <mtd> <mrow> <mi>cos</mi> <mi>&phi;</mi> <mi>cos</mi> <mi>&theta;</mi> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow>

其中,分別為機體坐標系{B}下右、左視圖所對應的無人機位置的x方向坐標,分別右、左視圖在圖像坐標系下的像素位置的y方向坐標;

步驟3.3、對滿足T≥Dpt的任意兩個視覺測量點配對為一組,共有n組,利用公式(2)計算每組相對高度hj,j=1,2,...n,然后求平均值

步驟3.4、獲得相對高度后,基于攝像機的測距模型和線性回歸方法計算航向偏差δψ。

當前第2頁1 2 3 
網(wǎng)友詢問留言 已有0條留言
  • 還沒有人留言評論。精彩留言會獲得點贊!
1
浮梁县| 当涂县| 茶陵县| 灵台县| 苍山县| 洱源县| 苗栗市| 台北县| 陇南市| 阿城市| 阿城市| 康定县| 永靖县| 仁寿县| 宣化县| 依兰县| 永清县| 昭觉县| 大连市| 白沙| 体育| 洛扎县| 漳浦县| 宝丰县| 抚顺市| 石狮市| 湟源县| 西吉县| 商南县| 台湾省| 兴业县| 麻栗坡县| 英山县| 沐川县| 瑞丽市| 兴文县| 民勤县| 金华市| 焦作市| 民权县| 大同市|