国产精品1024永久观看,大尺度欧美暖暖视频在线观看,亚洲宅男精品一区在线观看,欧美日韩一区二区三区视频,2021中文字幕在线观看

  • <option id="fbvk0"></option>
    1. <rt id="fbvk0"><tr id="fbvk0"></tr></rt>
      <center id="fbvk0"><optgroup id="fbvk0"></optgroup></center>
      <center id="fbvk0"></center>

      <li id="fbvk0"><abbr id="fbvk0"><dl id="fbvk0"></dl></abbr></li>

      基于多點(diǎn)GPS的無(wú)人駕駛汽車行駛中的航跡推算算法的制作方法

      文檔序號(hào):12269127閱讀:來(lái)源:國(guó)知局

      技術(shù)特征:

      1.一種基于多點(diǎn)GPS的無(wú)人駕駛汽車行駛中的航跡推算方法,其特征在于:具有如下步驟:

      步驟1:首先通過(guò)激光掃描雷達(dá)建立環(huán)境地圖,獲取車輛周圍的地理位置信息;

      步驟2:兩個(gè)GPS導(dǎo)航系統(tǒng)分別安裝在車輛的左、右側(cè),兩個(gè)GPS導(dǎo)航系統(tǒng)對(duì)車輛進(jìn)行定位;

      步驟3:通過(guò)兩個(gè)GPS導(dǎo)航系統(tǒng)分別獲取左邊目標(biāo)地點(diǎn)以及車身方位角信息以及獲取右邊目標(biāo)地點(diǎn)以及車身方位角信息;

      步驟4:采用航跡推算算法分別對(duì)兩個(gè)定位系統(tǒng)獲取到的信息進(jìn)行處理,計(jì)算出車輛的位置信息和行駛軌跡。

      2.根據(jù)權(quán)利要求1所述的基于多點(diǎn)GPS的無(wú)人駕駛汽車行駛中的航跡推算方法,其特征在于:所述航跡推算算法步驟如下:

      (1)該算法采用絕對(duì)坐標(biāo)系,用縱坐標(biāo)軸(Y)指向北方即磁北向,用橫軸(X)指向東方;

      (2)獲取采樣時(shí)間間隔i(i=0,1,2,····n)的縱向距離為d(i);

      (3)獲取無(wú)人駕駛汽車縱向與磁北向的夾角α(i),磁北向與真北向之間的夾角為αb;

      (4)無(wú)人駕駛汽車縱向與真北向的夾角α′(i)為如下公式所得出;

      α′(i)=α(i)+αb;

      (5)根據(jù)以下公式確定無(wú)人駕駛汽車在第n個(gè)采樣時(shí)刻的位置(x(n),y(n)):

      <mrow> <mi>x</mi> <mrow> <mo>(</mo> <mi>n</mi> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>x</mi> <mn>0</mn> </msub> <mo>+</mo> <munderover> <mo>&Sigma;</mo> <mrow> <mi>i</mi> <mo>=</mo> <mn>0</mn> </mrow> <mrow> <mi>n</mi> <mo>-</mo> <mn>1</mn> </mrow> </munderover> <mi>d</mi> <mrow> <mo>(</mo> <mi>i</mi> <mo>)</mo> </mrow> <msup> <mi>sin&alpha;</mi> <mo>&prime;</mo> </msup> <mrow> <mo>(</mo> <mi>i</mi> <mo>)</mo> </mrow> <mo>;</mo> </mrow>

      <mrow> <mi>y</mi> <mrow> <mo>(</mo> <mi>n</mi> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>+</mo> <munderover> <mo>&Sigma;</mo> <mrow> <mi>i</mi> <mo>=</mo> <mn>0</mn> </mrow> <mrow> <mi>n</mi> <mo>-</mo> <mn>1</mn> </mrow> </munderover> <mi>d</mi> <mrow> <mo>(</mo> <mi>i</mi> <mo>)</mo> </mrow> <msup> <mi>cos&alpha;</mi> <mo>&prime;</mo> </msup> <mrow> <mo>(</mo> <mi>i</mi> <mo>)</mo> </mrow> <mo>;</mo> </mrow>

      (6)設(shè)定采樣周期T固定,在第i(i=0,1,2,····n)個(gè)采樣時(shí)刻無(wú)人駕駛汽車的縱向速度為v(i),小車的行駛軌跡由以下公式得出:

      <mrow> <mi>x</mi> <mrow> <mo>(</mo> <mi>n</mi> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>x</mi> <mn>0</mn> </msub> <mo>+</mo> <mi>T</mi> <munderover> <mo>&Sigma;</mo> <mrow> <mi>i</mi> <mo>=</mo> <mn>0</mn> </mrow> <mrow> <mi>n</mi> <mo>-</mo> <mn>1</mn> </mrow> </munderover> <mi>v</mi> <mrow> <mo>(</mo> <mi>i</mi> <mo>)</mo> </mrow> <msup> <mi>sin&alpha;</mi> <mo>&prime;</mo> </msup> <mrow> <mo>(</mo> <mi>i</mi> <mo>)</mo> </mrow> <mo>;</mo> </mrow>

      <mrow> <mi>y</mi> <mrow> <mo>(</mo> <mi>n</mi> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>+</mo> <mi>T</mi> <munderover> <mo>&Sigma;</mo> <mrow> <mi>i</mi> <mo>=</mo> <mn>0</mn> </mrow> <mrow> <mi>n</mi> <mo>-</mo> <mn>1</mn> </mrow> </munderover> <mi>v</mi> <mrow> <mo>(</mo> <mi>i</mi> <mo>)</mo> </mrow> <msup> <mi>cos&alpha;</mi> <mo>&prime;</mo> </msup> <mrow> <mo>(</mo> <mi>i</mi> <mo>)</mo> </mrow> <mo>.</mo> </mrow>

      當(dāng)前第2頁(yè)1 2 3 
      網(wǎng)友詢問(wèn)留言 已有0條留言
      • 還沒(méi)有人留言評(píng)論。精彩留言會(huì)獲得點(diǎn)贊!
      1