四旋翼自主精準(zhǔn)降落平臺(tái)設(shè)計(jì)

甘培源 梅聰聰 謝逸菲

摘 要：針對(duì)無(wú)人機(jī)當(dāng)前精準(zhǔn)導(dǎo)航難、能源補(bǔ)充能力差等關(guān)鍵問(wèn)題，基于物聯(lián)網(wǎng)技術(shù)的方法與思想，結(jié)合在發(fā)展的無(wú)人機(jī)技術(shù)支持，設(shè)計(jì)一種適用于四旋翼的自主精準(zhǔn)降落平臺(tái)。該平臺(tái)包括基于超聲定位原理的“一發(fā)四收”裝置實(shí)現(xiàn)無(wú)人機(jī)降落過(guò)程全時(shí)段精準(zhǔn)定位，基于STM32單片機(jī)的飛行輔助控制裝置實(shí)現(xiàn)降落過(guò)程專項(xiàng)控制，LoRa模塊實(shí)現(xiàn)“機(jī)-地”通信，無(wú)線充電裝置實(shí)現(xiàn)無(wú)人機(jī)降落后的能源補(bǔ)充。以該降落平臺(tái)為基礎(chǔ)，可以發(fā)展包括車載無(wú)人機(jī)、物流無(wú)人機(jī)、巡防無(wú)人機(jī)等眾多無(wú)人機(jī)產(chǎn)業(yè)，助力無(wú)人機(jī)技術(shù)和應(yīng)用的發(fā)展，具有廣闊的市場(chǎng)前景。

關(guān)鍵詞：四旋翼;無(wú)人機(jī)技術(shù);超聲定位;STM32;無(wú)線充電;能源補(bǔ)充

中圖分類號(hào)：TP368.2;V249.122+.5文獻(xiàn)標(biāo)識(shí)碼：A文章編號(hào)：2095-1302（2019）08-00-03

0 引 言

四旋翼具有體型小、成本低、環(huán)境適應(yīng)力和反應(yīng)力強(qiáng)等特點(diǎn)，同時(shí)還具備高、廣視角等優(yōu)勢(shì)，被廣泛應(yīng)用于軍事、農(nóng)業(yè)、救援勘探、物流、航拍攝影等領(lǐng)域[1]。因此，以四旋翼為典型的無(wú)人機(jī)家族成為未來(lái)通用航空業(yè)發(fā)展方向的代表，在近年來(lái)被賦予了更多的重定義與希望，甚至被認(rèn)為是國(guó)家經(jīng)濟(jì)增長(zhǎng)的新動(dòng)力之一。

相關(guān)統(tǒng)計(jì)數(shù)據(jù)表明，60%以上的飛行事故都發(fā)生在起飛降落階段，而起飛降落階段中后者又超半數(shù)。究其原因，在降落過(guò)程中，飛行器被控量多、控制精度要求高，為飛行安全引入諸多不利因素[2]。除飛行控制外，無(wú)人機(jī)的續(xù)航能力也是重要的技術(shù)性能之一。當(dāng)前無(wú)人機(jī)航模電池多為鋰電池，其續(xù)航時(shí)間最長(zhǎng)只能維持在20 min左右，這導(dǎo)致無(wú)人機(jī)作業(yè)時(shí)經(jīng)常需要多次起降進(jìn)行能源補(bǔ)充[3]。傳統(tǒng)的有線充電方式使得充電過(guò)程變得復(fù)雜，同時(shí)反復(fù)的插拔會(huì)導(dǎo)致充電接口損壞。

在此背景下，針對(duì)無(wú)人機(jī)技術(shù)現(xiàn)階段存在的自主導(dǎo)航定位難、續(xù)航能力差等關(guān)鍵問(wèn)題進(jìn)行研究，進(jìn)一步發(fā)掘四旋翼飛行器的潛力，提高其可靠性、自主性、易用性，降低安全風(fēng)險(xiǎn)。本文提出的降落平臺(tái)較好地解決了小面積平臺(tái)上精準(zhǔn)降落和能源補(bǔ)充問(wèn)題。

1 整體方案

針對(duì)無(wú)人機(jī)降落問(wèn)題，本文提出一套全新的無(wú)人機(jī)自動(dòng)降落流程：在傳統(tǒng)衛(wèi)星定位導(dǎo)航基礎(chǔ)上，提出采用“一發(fā)四收”超聲定位裝置對(duì)降落時(shí)段的無(wú)人機(jī)進(jìn)行實(shí)時(shí)精準(zhǔn)定位;并設(shè)計(jì)飛行輔助控制裝置，其上搭載LoRa無(wú)線通信模塊實(shí)現(xiàn)“機(jī)-地”間坐標(biāo)信息傳輸后，進(jìn)而對(duì)降落過(guò)程實(shí)現(xiàn)專項(xiàng)輔助控制以及無(wú)人機(jī)厘米級(jí)的智能降落。

在精準(zhǔn)降落基礎(chǔ)上，為解決無(wú)人機(jī)能源問(wèn)題，以提高能量補(bǔ)充效率為出發(fā)點(diǎn)，基于無(wú)線充電思想對(duì)降落平臺(tái)本身結(jié)構(gòu)做出調(diào)整。無(wú)線充電裝置相對(duì)于傳統(tǒng)有線裝置更加便捷，省去了操作員插拔接線的多余工作同時(shí)也避免了可能出現(xiàn)的接口損壞等狀況。

2 整體設(shè)計(jì)

在整體方案的思想指導(dǎo)下，設(shè)計(jì)如圖1所示的降落平臺(tái)系統(tǒng)，其在傳統(tǒng)無(wú)人機(jī)結(jié)構(gòu)的基礎(chǔ)上還包括：“一發(fā)四收”超聲定位裝置的接收與發(fā)射部分、數(shù)據(jù)中轉(zhuǎn)站、飛行輔助控制裝置和無(wú)線充電裝置。

3 定位設(shè)計(jì)

當(dāng)前廣泛應(yīng)用于機(jī)載衛(wèi)星定位裝置的定位精度為2 m左右，僅僅能夠?qū)崿F(xiàn)無(wú)人機(jī)基本返航至操作員的可視距離或設(shè)定降落點(diǎn)數(shù)米的范圍內(nèi)[4]。這樣的結(jié)果顯然不能夠滿足具有面積限制或空間限制的降落需求，并且使無(wú)人機(jī)的回收變得十分困難，更談不上智能化、自主化。由此看來(lái)，選定合適精度的定位裝置并對(duì)運(yùn)動(dòng)目標(biāo)的實(shí)時(shí)跟蹤定位是精準(zhǔn)降落導(dǎo)航的前提。

查閱大量資料文獻(xiàn)，比較多重定位手段后，本文決定采用超聲定位技術(shù)。當(dāng)前常見的超聲測(cè)距模塊多為“收發(fā)一體”。其測(cè)距原理為：計(jì)算超聲波從發(fā)射經(jīng)障礙物反射到最后接收的用時(shí)乘以時(shí)間所得值的半數(shù)來(lái)得到待測(cè)物體的距

離[5]。通過(guò)實(shí)際試驗(yàn)發(fā)現(xiàn)，單個(gè)超聲測(cè)距模塊具有精度高、質(zhì)量輕等優(yōu)勢(shì)，但卻可能因?yàn)樗鶞y(cè)距離為超聲波往返值而在遠(yuǎn)距離情況下時(shí)效性差，同時(shí)航模電池對(duì)超聲模塊過(guò)近易產(chǎn)生干擾。

綜上所述，在此以“收發(fā)分離”為思想，采用“一發(fā)四收”超聲定位裝置。裝置采集實(shí)時(shí)坐標(biāo)，模擬實(shí)現(xiàn)對(duì)運(yùn)動(dòng)無(wú)人機(jī)目標(biāo)實(shí)時(shí)定位與跟蹤，從而獲得運(yùn)動(dòng)目標(biāo)的運(yùn)動(dòng)參數(shù)及運(yùn)動(dòng)軌跡，為完成更高一級(jí)任務(wù)打好基礎(chǔ)。

“一發(fā)四收”超聲定位裝置包括一個(gè)機(jī)載超聲波發(fā)射器和4個(gè)安裝在降落平臺(tái)的超聲波接收器，控制模塊被設(shè)置在平臺(tái)背面，如圖2所示。在降落階段，發(fā)射器與接收器構(gòu)成空間四棱錐?？刂颇K每隔300 ms向超聲發(fā)射器和接收器發(fā)送特定地址信息控制其工作并獲得4個(gè)所測(cè)距離值，即四棱錐棱長(zhǎng);可設(shè)定接收器兩兩間距為定值即四棱錐底邊長(zhǎng)。此時(shí)四旋翼坐標(biāo)問(wèn)題即轉(zhuǎn)換為已知四棱錐各邊長(zhǎng)求四棱錐定點(diǎn)的幾何問(wèn)題。

以左下角超聲接收器為原點(diǎn)建立圖2所示的空間直角坐標(biāo)系，以S1，S2，S3為例，列出以下三元二次方程：

可求得無(wú)人機(jī)的三維坐標(biāo)Point 1：

同理對(duì)S2，S3，S4;S1，S2，S4;S1，S3，S4三組數(shù)據(jù)進(jìn)行計(jì)算，又可得到對(duì)應(yīng)的坐標(biāo)Point 2，Point 3，Point 4。將此四值進(jìn)行均值處理后可得到相對(duì)準(zhǔn)確的三維坐標(biāo)信息，被保存在控制模塊中。

4 控制單元設(shè)計(jì)

當(dāng)前，四旋翼的控制結(jié)構(gòu)一般為：接收機(jī)與遙控發(fā)射機(jī)以2.4 GHz無(wú)線通信方式傳輸信號(hào)，接收機(jī)與飛控有線連接。但基于降落過(guò)程專項(xiàng)單元專項(xiàng)控制的思想，筆者設(shè)置了嵌入式單片機(jī)作為飛控的輔助控制單元：將飛控與接收機(jī)通過(guò)STM32單片機(jī)相連。在飛行輔助控制裝置與定位裝置的控制端間設(shè)置LoRa無(wú)線通信模塊，解決坐標(biāo)信息的“機(jī)-地”傳輸;搭載MPU6050傳感器以實(shí)時(shí)獲取姿態(tài)角信息。三維坐標(biāo)信息（x，y，z）與姿態(tài)角信息（pitch，roll，yaw）兩組六項(xiàng)數(shù)據(jù)共同為無(wú)人機(jī)姿態(tài)控制提供更新變量，采用常見的無(wú)人機(jī)PID控制算法即可實(shí)現(xiàn)對(duì)無(wú)人機(jī)降落階段的精準(zhǔn)控制[6-7]。

作為飛行輔助控制裝置的核心，STM32單片機(jī)通過(guò)定時(shí)器捕獲和輸出PWM波信號(hào)可實(shí)現(xiàn)對(duì)遙控器控制的接收機(jī)信號(hào)的獲取以及向飛控等輸出值的過(guò)程，即遙控飛行模式;以獲取到坐標(biāo)作為中斷觸發(fā)標(biāo)志，可切換至降落模式。

專項(xiàng)控制思路因并未對(duì)原有結(jié)構(gòu)本身做出改變，僅僅是在兩個(gè)原有模塊中增加了一個(gè)連接單元，所以幾乎適用于各類機(jī)型，通用性較強(qiáng)。優(yōu)化的無(wú)人機(jī)控制單元結(jié)構(gòu)圖如圖3所示。

5 無(wú)線充電設(shè)計(jì)

在精準(zhǔn)降落的前提下，筆者在降落平臺(tái)上增加無(wú)線充電裝置以實(shí)現(xiàn)降落后無(wú)人機(jī)更加便捷地能量補(bǔ)充。當(dāng)前市面上的無(wú)線充電裝置種類繁多，其原理依據(jù)大都是以發(fā)射線圈和接收線圈諧振方式的磁傳輸[8]。

降落平臺(tái)的中心部分被絕緣物質(zhì)圓形填充，避免耦合時(shí)導(dǎo)體材料的干擾[9]。無(wú)人機(jī)電池與接收線圈相連，隨無(wú)人機(jī)精準(zhǔn)降落后與發(fā)射線圈對(duì)接，此時(shí)打開發(fā)射線圈的電源開關(guān)即可開始充電。此功能省去了操作員插拔接線的多余工作，同時(shí)也避免了可能出現(xiàn)的接口損壞等狀況。無(wú)線充電原理圖如圖4所示。

6 實(shí)驗(yàn)驗(yàn)證

6.1 定位實(shí)驗(yàn)

定位實(shí)驗(yàn)時(shí)，在超聲波發(fā)射端采用獨(dú)立電源供電并單獨(dú)固定放置，如圖5所示。

定位具體步驟為：

（1）將降落平臺(tái)垂直于桌面放置，即“一發(fā)四收”定位裝置的四個(gè)接收端所在平面垂直于桌面;

（2）將單獨(dú)供電的超聲波發(fā)射端也垂直于桌面并使發(fā)射頭直射向四個(gè)接收端;

（3）遵循之前設(shè)定的三維坐標(biāo)系，可通過(guò)測(cè)量方式較為準(zhǔn)確地給出當(dāng)前超聲波發(fā)射端在此坐標(biāo)系中的坐標(biāo)值，將定位裝置所測(cè)得的坐標(biāo)值與實(shí)測(cè)坐標(biāo)值比較并記錄;

（4）調(diào)整超聲波發(fā)射端在上述坐標(biāo)系中的位置，重復(fù)步驟（3）以得到多組對(duì)比值，如圖6所示。

6.2 降落實(shí)驗(yàn)

本文設(shè)計(jì)如圖7所示的平臺(tái)作為無(wú)人機(jī)降落后的支撐部分以及各模塊的搭載平臺(tái)。四個(gè)超聲波接收探頭嵌置于小圓孔下，且探頭通過(guò)小圓孔露出，同時(shí)保證探頭與平臺(tái)表面處于同一水平面。

為了保證降落實(shí)驗(yàn)的安全性，采用5 mm牽引繩連接無(wú)人機(jī)機(jī)架并將另一端于地面固定。在平臺(tái)上不同的空位置開始降落，降落結(jié)束后測(cè)量無(wú)人機(jī)幾何中心相對(duì)降落平臺(tái)位置。圖8為隨機(jī)放置無(wú)人機(jī)開始降落過(guò)程后，無(wú)人機(jī)最終降落點(diǎn)位置分布圖。顯然可以觀察到幾乎所有降落點(diǎn)都與降落閾值邊界所構(gòu)成的邊長(zhǎng)為2 cm的正方形吻合，說(shuō)明了定位裝置及降落算法的可行性。

7 結(jié) 語(yǔ)

本文設(shè)計(jì)一種以四旋翼無(wú)人機(jī)為對(duì)象的精準(zhǔn)降落平臺(tái)并能夠?qū)德浜蟮臒o(wú)人機(jī)進(jìn)行無(wú)線充電。通過(guò)理論分析和實(shí)驗(yàn)驗(yàn)證，本文的降落方案可行且定位裝置的實(shí)時(shí)精度可達(dá)毫米級(jí)，設(shè)置降落精度可達(dá)厘米級(jí)，同時(shí)平臺(tái)搭載無(wú)線充電裝置避免了有線充電方式繁瑣和反復(fù)插拔導(dǎo)致的接口損壞現(xiàn)象，提升飛行作業(yè)效率。以該降落平臺(tái)為基礎(chǔ)，可以發(fā)展包括車載無(wú)人機(jī)[10]、物流無(wú)人機(jī)、巡防無(wú)人機(jī)等眾多無(wú)人機(jī)產(chǎn)業(yè)，助力無(wú)人機(jī)技術(shù)和應(yīng)用的發(fā)展，具有廣闊的市場(chǎng)前景。

參 考 文 獻(xiàn)

[1]杜鵬輝.四旋翼飛行器飛行控制方法研究[D].深圳：深圳大學(xué)，2016.

[2]楊國(guó)松.四旋翼飛行器自動(dòng)降落研究[D].成都：電子科技大學(xué)，2017.

[3]金伽憶，朱燁，曾舒婷，等.小型多旋翼無(wú)人機(jī)續(xù)航問(wèn)題研究[J].電腦知識(shí)與技術(shù)，2017（16）：197-199.

[4]王閱兵，游新兆，金紅林，等.北斗導(dǎo)航系統(tǒng)與GPS精密單點(diǎn)定位精度的對(duì)比分析[J].大地測(cè)量與地球動(dòng)力學(xué)，2014（4）：110-116.

[5]李茂山.超聲波測(cè)距原理及實(shí)踐技術(shù)[J].實(shí)用測(cè)試技術(shù)，1994（1）：12-20.

[6]鄭健.基于無(wú)模型自適應(yīng)控制方法的四旋翼飛行器姿態(tài)調(diào)整[D].北京：北京交通大學(xué)，2015.

[7]陳聽雨.四旋翼飛行器建模、仿真與PID控制[J].電子世界，2018（21）：5-7.

[8]陳昌虎.電力巡線四旋翼飛行器自主充電系統(tǒng)的設(shè)計(jì)與實(shí)現(xiàn)[D].杭州：浙江大學(xué)，2016.

[9]李陽(yáng)，楊慶新，閆卓，等.無(wú)線電能有效傳輸距離及其影響因素分析[J].電工技術(shù)學(xué)報(bào)，2013（1）：106-112.

[10]賈配洋，彭曉東，周武根.四旋翼無(wú)人機(jī)自主移動(dòng)降落方法研究[J].計(jì)算機(jī)科學(xué)，2017（z2）：520-523.