農(nóng)業(yè)無人機
工業(yè)無人機
軍警無人機
娛教無人機
水下無人機
反無人機設備
無人機配件
無人機租賃
無人機培訓
當前位置:全球無人機網(wǎng) ? 無人機技術 ? 技術 ? 正文

無人機航線規(guī)劃思路剖析,基于凸多邊形地塊往復式運動

發(fā)布日期:2017-09-18??來源:CharTen我要投稿我要評論

寫在前面

嗨!很高興看到你點進來閱讀這篇文章,請別介意,標題有點長有點啰嗦(完全是為了seo考慮),但也算是概括了這篇文章的內(nèi)容。如果你是要開發(fā)如下圖所示的場景,但又苦于沒什么好的思路,那么這篇文章一定會幫助到你!

無人機航線規(guī)劃思路剖析,基于凸多邊形地塊往復式運動

往復式運動航線

無人機航線規(guī)劃思路剖析,基于凸多邊形地塊往復式運動

基于不規(guī)則凸多邊形地塊的往復式航線規(guī)劃

哦,對了,本文的實現(xiàn)是基于web平臺的地圖,使用javascript。如果你也是在web平臺上開發(fā),而且任務時間非常緊急,沒有時間閱讀完全文的話。。。我已經(jīng)將本文的思路封裝成一個庫了,你可以猛戳下面的鏈接,開箱即用:
github.com/Char-Ten/cp…
兼容各大地圖平臺api(其實不同平臺api差異的影響很低)哦,不信的話戳demo:
百度地圖demo
高德地圖demo
leaflet地圖demo
覺得好用的話記得給個star~原創(chuàng)不易,謝謝支持

正文!

其實也是套公式

其實這種問題,實際上是數(shù)學幾何應用題,既然是數(shù)學題啦,那按照考試的套路第一步肯定是套公式啊,這種場景,核心的公式不多,就兩條:

  • 無人機航線規(guī)劃思路剖析,基于凸多邊形地塊往復式運動

  • 一次函數(shù)兩點表達式
  •  
  • 無人機航線規(guī)劃思路剖析,基于凸多邊形地塊往復式運動

  • 繞(tx,ty)點旋轉(zhuǎn)n度之后縮放SxSy倍的變換矩陣

第一條沒什么可以說的,初二數(shù)學就開始教一次函數(shù)的知識,這一條是用來計算航線與地塊邊界的交點的。 第二條就是很經(jīng)典的復合變換矩陣了,分別是位移矩陣叉乘旋轉(zhuǎn)矩陣叉乘位移縮放矩陣,我們設其叉乘結(jié)果為A,那么我們就可以列出下面的等式:


無人機航線規(guī)劃思路剖析,基于凸多邊形地塊往復式運動

計算過程就是。。。橫乘豎橫乘豎橫乘豎橫乘豎橫乘豎橫乘豎橫乘豎橫乘豎。。。。最后化為用于程序的代數(shù)式就是:


無人機航線規(guī)劃思路剖析,基于凸多邊形地塊往復式運動

通過這條公式,就可以計算出航線旋轉(zhuǎn)后的坐標點。

然后我們把它們分別封裝一下,弄成一個函數(shù)調(diào)用先:
  無人機航線規(guī)劃思路剖析,基于凸多邊形地塊往復式運動

看到這里,恭喜你,你已經(jīng)完成了50%的工作量!如果是在考試,你把這兩條公式列出來,不寫答案也有一半的分數(shù)(

先從最簡單的場景開始

一個矩形地塊,航線水平于x軸:

無人機航線規(guī)劃思路剖析,基于凸多邊形地塊往復式運動

這是一個大概是200*200大小的矩形,左上角的頂點經(jīng)緯度為nw(西北),右上角的頂點經(jīng)緯度為ne(東北),右下角的頂點經(jīng)緯度為se(東南),左下角的頂點經(jīng)緯度為sw(西南),其中設置無人機飛行的間隔為10。你先不考慮折線的連接順序,就單單考慮一下,每一根橫線如何生成。觀察一下你會發(fā)現(xiàn)以下規(guī)律:
  1. 兩條橫線的間隔是20
  2. 每一條橫線都可以表示為 y=N,N為常數(shù),表示某個緯度值
  3. 每一條橫線段都是y=N與矩形相交產(chǎn)生,也就是每一條橫線段都是該矩形地塊與維度相交的結(jié)果

那么,現(xiàn)在矩形的四個頂點的經(jīng)緯度是已知的,無人機飛行的間隔也是已知的,這個矩形需要與多少條緯度線相交是未知的,每一條橫線的N是未知的,每一條橫線段左右兩個點的緯度是未知的。根據(jù)已知求未知,你的目標已經(jīng)很明確了,一道很簡單的幾何題:

  • 該矩形需要與多少條緯度線相交:
無人機航線規(guī)劃思路剖析,基于凸多邊形地塊往復式運動
  • 求每一條橫線的N:
無人機航線規(guī)劃思路剖析,基于凸多邊形地塊往復式運動
  • 因為矩形的兩條邊是垂直的,所以,橫線段左右兩個點的經(jīng)度分別為nw.lng,ne.lng。這樣我們就可以繪制出來了:
無人機航線規(guī)劃思路剖析,基于凸多邊形地塊往復式運動

場景開始變形!

鏘鏘,我們把矩形上面的邊往東挪50米,得到一個平行四邊形:

無人機航線規(guī)劃思路剖析,基于凸多邊形地塊往復式運動

聰明的你一定發(fā)現(xiàn)了,平行四邊形在Y軸上的投影根本沒有發(fā)生變化嘛,即使變了之后,穿過地塊的緯度線數(shù)目還是不變嘛,只不過,這次因為兩條邊不是垂直的,所以,我們需要計算斜邊與緯度線的交點。等等,你這時候想起了,最開始50%工作量里面所封裝的那個calcPointInLineWithY函數(shù)!
你已經(jīng)知道斜邊兩個點的坐標,然后你又知道y=N,那你通過一次函數(shù)的兩點表達式,完全就可以知道x,也就是經(jīng)度是多少啦:

 

那你可以再變一變,讓y軸上的投影也發(fā)生變化,就像這樣:

無人機航線規(guī)劃思路剖析,基于凸多邊形地塊往復式運動

好了,這下你觀察到,每條邊都跟緯度線相交了,也就是說,這次你要遍歷一下這個平行四邊形四個頂點。等等,你似乎忘記了一個問題,這個四邊形在y軸上的投影發(fā)生了變化,相交緯度線數(shù)目也跟著發(fā)生變化了。這時候你想到,要不給這個多邊形做個外接矩形?就像這樣:

無人機航線規(guī)劃思路剖析,基于凸多邊形地塊往復式運動

這樣是不是又回歸了最開始的場景?只是把calcPointInLineWithY函數(shù)加上去之后,你可以得到任意凸多邊形與緯度線相交的模型。

?
本文鏈接:http://www.sanehomeowner.com/tech/201709/18/528.html
標簽:??
0相關評論
免責聲明:凡注明來源全球無人機網(wǎng)的所有作品,均為本網(wǎng)合法擁有版權或有權使用的作品,歡迎轉(zhuǎn)載,請注明出處。非本網(wǎng)作品均來自互聯(lián)網(wǎng),轉(zhuǎn)載目的在于傳遞更多信息,并不代表本網(wǎng)贊同其觀點和對其真實性負責。

圖文推薦

推薦新聞

推薦品牌

關于本站

合作服務電話

  • 客服熱線:0755-23779287
  • 展會負責:18682042306
  • 廣告合作:點擊這里給我發(fā)消息
  • 展會合作:點擊這里給我發(fā)消息

公眾號/APP下載


    (公眾號)


    (Android下載)

Copyright?2005-2021 81UAV.CN All Rights Reserved? 訪問和使用全球無人機網(wǎng),即表明您已完全接受和服從我們的用戶協(xié)議。 SITEMAPS 網(wǎng)站地圖 網(wǎng)站留言
運營商: 湛江中龍網(wǎng)絡科技有限公司 全球無人機網(wǎng)?
ICP備案號:粵ICP備2023038372號-1 
全國公安機關?備案信息?可信網(wǎng)站不良舉報?文明轉(zhuǎn)播