亚洲成年人黄色一级片,日本香港三级亚洲三级,黄色成人小视频,国产青草视频,国产一区二区久久精品,91在线免费公开视频,成年轻人网站色直接看

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

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

技術(shù)特征:

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

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

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

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

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

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

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

步驟3.2、設(shè)基線距的閾值為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}下右、左視圖所對應(yīng)的無人機位置的x方向坐標,分別右、左視圖在圖像坐標系下的像素位置的y方向坐標;

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

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

當前第2頁1 2 3 
網(wǎng)友詢問留言 已有0條留言
  • 還沒有人留言評論。精彩留言會獲得點贊!
1