簡(jiǎn)介面向無(wú)人機(jī)飛行控制場(chǎng)景的C工程源碼包適合飛控開(kāi)發(fā)學(xué)習(xí)者與嵌入式軟件工程師幫助理解多旋翼/小型無(wú)人機(jī)在姿態(tài)控制、任務(wù)調(diào)度與無(wú)線通信方面的軟件實(shí)現(xiàn)。包內(nèi)為可編譯的模塊化飛控項(xiàng)目按src、tasks、config、monitor、wireless、display等目錄組織集中呈現(xiàn)PID姿態(tài)控制、傳感器數(shù)據(jù)接入、路徑規(guī)劃、Mavlink通信、安全故障處理等核心代碼便于對(duì)照源碼梳理飛控軟件架構(gòu)與實(shí)時(shí)控制邏輯。壓縮包共73個(gè)文件以hpp/cpp源碼為主合計(jì)47個(gè)輔以少量txt/json/md配置與說(shuō)明文檔整體僅68KB輕量易拾取適合快速閱讀、二次開(kāi)發(fā)或教學(xué)演示。資源已有953人學(xué)習(xí)下載對(duì)想用C構(gòu)建或改造無(wú)人機(jī)控制器的開(kāi)發(fā)者具有實(shí)際參考價(jià)值。 玩無(wú)人機(jī)的朋友十有八九都被控制器這三個(gè)字繞暈過(guò)。剛?cè)肟訒r(shí)以為無(wú)人機(jī)控制器就是手里那個(gè)遙控器后來(lái)發(fā)現(xiàn)飛控板也叫控制器再后來(lái)接觸地面站發(fā)現(xiàn)電腦軟件也能當(dāng)控制器。到底哪個(gè)才是真正的無(wú)人機(jī)控制器這問(wèn)題我當(dāng)年也困惑了很久踩了不少坑才把整條鏈路理順。這篇內(nèi)容我就把自己從遙控器選型、飛控調(diào)參到整機(jī)聯(lián)調(diào)的經(jīng)驗(yàn)完整拆一遍尤其適合準(zhǔn)備入FPV穿越機(jī)、航拍機(jī)或者自制無(wú)人機(jī)的朋友幫你少走彎路。1. 無(wú)人機(jī)控制器的全景認(rèn)知遙控器、飛控還是整條鏈路1.1 三種控制器的邊界與常見(jiàn)誤區(qū)先給個(gè)最直白的結(jié)論無(wú)人機(jī)控制器不是一個(gè)硬件而是從你的手指到電機(jī)轉(zhuǎn)動(dòng)的整條控制鏈路。日常大家說(shuō)的控制器實(shí)際上覆蓋了三層?xùn)|西。第一層是遙控器發(fā)射機(jī)接收機(jī)負(fù)責(zé)把人的操作意圖變成無(wú)線電信號(hào)這是狹義上的遙控器第二層是飛控系統(tǒng)Flight Controller負(fù)責(zé)接收遙控信號(hào)、讀取傳感器數(shù)據(jù)、計(jì)算姿態(tài)并輸出電機(jī)指令這是一個(gè)巴掌大小的電路板上面有陀螺儀、加速度計(jì)、氣壓計(jì)、MCU等第三層是地面站軟件比如Mission Planner、Betaflight Configurator負(fù)責(zé)參數(shù)調(diào)優(yōu)、航點(diǎn)規(guī)劃和數(shù)據(jù)回傳嚴(yán)格說(shuō)也是控制器的一部分。很多新手把遙控器和控制器劃等號(hào)這個(gè)誤區(qū)在選型時(shí)最容易踩。我見(jiàn)過(guò)一個(gè)朋友花大幾千買(mǎi)了一套高端遙控器結(jié)果飛控沒(méi)選對(duì)協(xié)議不匹配遙控器信號(hào)根本進(jìn)不了飛控。反過(guò)來(lái)也有人搞了個(gè)頂級(jí)飛控手里卻用著一個(gè)通道數(shù)量不夠的廉價(jià)遙控器導(dǎo)致很多飛控功能沒(méi)法通過(guò)遙控器開(kāi)關(guān)去觸發(fā)。這兩類人我都遇過(guò)問(wèn)題都出在沒(méi)把鏈路看全。1.2 遙控鏈路的核心構(gòu)成發(fā)射機(jī)、接收機(jī)、飛控把整條鏈路展開(kāi)信號(hào)流動(dòng)是這樣的你撥動(dòng)搖桿發(fā)射機(jī)把搖桿位置編碼成通道數(shù)據(jù)通過(guò)無(wú)線電發(fā)射出去接收機(jī)收到后把數(shù)據(jù)轉(zhuǎn)成飛控能讀的協(xié)議格式PWM、PPM、SBUS、CRSF等通過(guò)線材傳給飛控飛控拿到通道數(shù)據(jù)后結(jié)合姿態(tài)傳感器數(shù)據(jù)運(yùn)行PID控制算法輸出PWM/DShot信號(hào)給電調(diào)電調(diào)再去驅(qū)動(dòng)電機(jī)。這個(gè)鏈路里任何一個(gè)環(huán)節(jié)斷了飛機(jī)都飛不起來(lái)。最常見(jiàn)的斷點(diǎn)在接收機(jī)輸出格式和飛控輸入接口的匹配上。打個(gè)比方接收機(jī)說(shuō)的是SBUS串行總線協(xié)議飛控上的接收機(jī)端口卻默認(rèn)配置成PPM脈位調(diào)制兩者語(yǔ)言不通自然沒(méi)反應(yīng)。這類問(wèn)題我后面會(huì)專門(mén)講排查方法。2. 選型決策買(mǎi)成品還是自己做關(guān)鍵參數(shù)這么看2.1 遙控器選型的5個(gè)核心參數(shù)先說(shuō)不踩坑的選型思路。無(wú)論是玩航拍機(jī)、穿越機(jī)還是自制固定翼遙控器選型就看五個(gè)參數(shù)通道數(shù)、通信協(xié)議、手感與搖桿精度、續(xù)航與充電方式、拓展接口。通道數(shù)是最直觀的指標(biāo)通道越多能控制的動(dòng)作就越多。四旋翼基礎(chǔ)控制需要4個(gè)通道油門(mén)、方向、俯仰、橫滾但你要是想控制云臺(tái)俯仰、起落架、航拍快門(mén)、燈帶開(kāi)關(guān)就得往上加。我自己的建議是新手直接選8通道以上的遙控器別省這個(gè)錢(qián)。我當(dāng)年圖便宜買(mǎi)了6通道后來(lái)想加個(gè)失控返航開(kāi)關(guān)和蜂鳴器開(kāi)關(guān)通道就緊張得不行最后只能把云臺(tái)俯仰和航拍快門(mén)做成組合鍵用起來(lái)別扭得很。通信協(xié)議是選型時(shí)最容易被忽略又最致命的一項(xiàng)。不同品牌的遙控器有各自的協(xié)議FrSky的ACCST、Team BlackSheep的TBS Crossfire/CRSF、ELRSExpressLRS是目前穿越機(jī)領(lǐng)域的主流。遙控器、接收機(jī)必須支持同一協(xié)議才能對(duì)頻這就像對(duì)講機(jī)必須同頻段一樣。ELRS這兩年普及速度極快我目前主力設(shè)備已經(jīng)從FrSky遷移到了ELRS 2.4G延遲低、抗干擾好、開(kāi)源可玩性高新手老手都合適。手感與搖桿精度很主觀但有一點(diǎn)是硬指標(biāo)搖桿的霍爾傳感器優(yōu)于電位器。霍爾搖桿靠磁場(chǎng)感應(yīng)無(wú)物理接觸壽命長(zhǎng)、精度高、溫漂小電位器搖桿成本低但用久了會(huì)磨損發(fā)飄。如果你預(yù)算在千元以上直接奔著霍爾搖桿去。另外搖桿行程和彈簧力度也可以試有些人喜歡松一點(diǎn)的油門(mén)桿有些人喜歡緊的這個(gè)真得自己上手才舒服。續(xù)航與充電方式影響實(shí)際使用體驗(yàn)。有的遙控器用18650電池倉(cāng)有的內(nèi)置鋰電池支持Type-C充電我建議選內(nèi)置電池的出門(mén)少帶充電器現(xiàn)場(chǎng)省事。拓展接口方面至少需要一個(gè)教練口模擬器口或者無(wú)線USB接口這直接關(guān)系到你能否流暢地連接模擬器練習(xí)。練模擬器是提升技術(shù)最快的方式?jīng)]有之一所以接口一定要有。2.2 遙控器與飛控的匹配協(xié)議兼容性解析遙控器選完下一步就是讓它和飛控對(duì)上話。這個(gè)環(huán)節(jié)的關(guān)鍵是接收機(jī)輸出的信號(hào)格式。常見(jiàn)的有這么幾種PWM每個(gè)通道一根信號(hào)線老舊方案接線多通道數(shù)受物理接口限制。PPM把多個(gè)通道的脈寬信號(hào)疊加在一根線上傳輸串行解碼8通道以內(nèi)夠用。SBUSFrSky陣營(yíng)的標(biāo)準(zhǔn)串行協(xié)議通過(guò)一根信號(hào)線就能傳16個(gè)通道延遲低目前最主流之一。CRSFTBS的協(xié)議后起之秀延遲極低支持遙測(cè)回傳在高端FPV圈非常流行。DShot嚴(yán)格說(shuō)這是飛控到電調(diào)的協(xié)議不涉及遙控鏈路但新手常搞混提一下。我個(gè)人的匹配經(jīng)驗(yàn)是如果你用的是Betaflight類的穿越機(jī)飛控接收機(jī)優(yōu)先選SBUS或CRSF輸出接線最少、延遲最低、通道數(shù)最夠用如果是Pixhawk類的開(kāi)源飛控SBUS也很穩(wěn)但是要注意飛控端口的電平標(biāo)準(zhǔn)和線序有些飛控的SBUS口和遙測(cè)口挨在一起焊錯(cuò)就冒煙。注意買(mǎi)接收機(jī)時(shí)一定要確認(rèn)輸出協(xié)議可配置。很多接收機(jī)默認(rèn)PWM輸出需要通過(guò)跳線或者地面站軟件切換到SBUS/CRSF模式不然你只連一根信號(hào)線是收不到數(shù)據(jù)的。3. 從零調(diào)通一套無(wú)人機(jī)控制器對(duì)頻、校準(zhǔn)、解鎖全流程3.1 第一次開(kāi)箱對(duì)頻與通道映射拿到新遙控器和接收機(jī)第一步就是對(duì)頻。對(duì)頻的操作邏輯大同小異發(fā)射機(jī)進(jìn)入對(duì)頻模式接收機(jī)上電并觸發(fā)對(duì)頻按鍵/短接焊盤(pán)兩者握手成功后接收機(jī)的LED會(huì)從閃爍變成常亮。這里有三個(gè)容易踩的坑第一對(duì)頻前先確認(rèn)發(fā)射機(jī)的射頻功率設(shè)置。有些遙控器默認(rèn)是小功率模式對(duì)頻距離只有幾米你要是站在十米外對(duì)頻怎么都對(duì)不上還以為設(shè)備壞了。第二接收機(jī)如果之前已經(jīng)被別的遙控器綁定過(guò)需要先執(zhí)行清除綁定或者用特定的對(duì)頻方式強(qiáng)制覆蓋不然可能出現(xiàn)對(duì)上了又?jǐn)嚅_(kāi)的詭異現(xiàn)象。第三對(duì)頻成功后把遙控器關(guān)機(jī)再開(kāi)機(jī)接收機(jī)應(yīng)該能自動(dòng)重連。如果重連不上檢查發(fā)射機(jī)是否開(kāi)啟了綁定后自動(dòng)存儲(chǔ)模型選項(xiàng)。對(duì)頻完成下一步是通道映射。這個(gè)過(guò)程就是讓飛控知道遙控器的1通道對(duì)應(yīng)的是油門(mén)還是橫滾。在Betaflight的接收機(jī)頁(yè)面你撥動(dòng)搖桿能看到對(duì)應(yīng)的通道數(shù)值在變化。標(biāo)準(zhǔn)化做法是把遙控器的搖桿撥到中間位置校準(zhǔn)搖桿中點(diǎn)然后把通道順序在飛控里與遙控器發(fā)送順序?qū)R。大部分遙控器支持修改通道順序但更推薦在飛控軟件里做映射別動(dòng)遙控器的輸出順序否則你以后換模擬器或者換飛控又得重新理一遍。3.2 搖桿校準(zhǔn)與失控保護(hù)設(shè)置搖桿校準(zhǔn)是很多人跳過(guò)的步驟但這個(gè)步驟直接影響飛行手感。校準(zhǔn)的目的是讓飛控和遙控器對(duì)搖桿的物理行程、中點(diǎn)、最大值達(dá)成一致。在Betaflight里步驟是進(jìn)入接收機(jī)頁(yè)面點(diǎn)擊重新校準(zhǔn)搖桿按鈕然后把所有搖桿打到最大和最小位置再讓所有搖桿回到中點(diǎn)軟件會(huì)自動(dòng)記錄范圍。操作上有個(gè)小細(xì)節(jié)校準(zhǔn)過(guò)程中要保證遙控器搖桿居中時(shí)輸出值為1500左右PPM/SBUS標(biāo)準(zhǔn)中點(diǎn)油門(mén)最低為1000左右最高為2000左右。如果你發(fā)現(xiàn)數(shù)值偏差超過(guò)幾十檢查遙控器的通道微調(diào)和端點(diǎn)設(shè)置。失控保護(hù)FailSafe是我反復(fù)強(qiáng)調(diào)不能省的一步。沒(méi)有失控保護(hù)的飛機(jī)一旦信號(hào)丟失要么保持最后指令繼續(xù)飛要么直接切油門(mén)墜落兩種情況都很危險(xiǎn)。合理的設(shè)置邏輯是信號(hào)丟失后接收機(jī)輸出一個(gè)特殊指令讓飛控進(jìn)入預(yù)設(shè)的失控保護(hù)模式。對(duì)穿越機(jī)我通常會(huì)設(shè)為GPS Rescue如果有GPS或者至少設(shè)為降落對(duì)航拍機(jī)設(shè)為返航RTH更合理。具體操作上以FrSky/ELRS接收機(jī)為例在遙控器菜單里設(shè)置一個(gè)用于觸發(fā)失控保護(hù)的開(kāi)關(guān)通道然后在地面站里把這個(gè)通道配置為失控保護(hù)通道。更簡(jiǎn)單的方案是直接在飛控里設(shè)置接收機(jī)信號(hào)丟失時(shí)自動(dòng)切換到失控保護(hù)模式這樣即使接收機(jī)端沒(méi)配置飛控也能兜底。兩條路我都試過(guò)最穩(wěn)的是兩邊都設(shè)雙保險(xiǎn)。3.3 試飛前的地面檢查清單調(diào)參完成不代表能直接起飛我每次試飛前都過(guò)一遍地面檢查清單這習(xí)慣救了我好幾架飛機(jī)。清單如下電機(jī)轉(zhuǎn)向正確每個(gè)電機(jī)旋轉(zhuǎn)方向與飛控配置一致螺旋槳安裝方向與電機(jī)轉(zhuǎn)向匹配。螺旋槳鎖緊槳夾無(wú)松動(dòng)槳葉無(wú)裂紋。電池電壓充足蜂鳴器/電壓報(bào)警正常工作。遙控器與接收機(jī)對(duì)頻正常搖桿方向與飛控通道映射一致重點(diǎn)確認(rèn)推油時(shí)飛控顯示油門(mén)增大而不是減小。飛控安裝方向正確傳感器方向與飛控箭頭指向一致。解鎖后輕微推油確認(rèn)電機(jī)響應(yīng)平滑、無(wú)卡頓或抖動(dòng)然后馬上鎖定。這個(gè)清單看著繁瑣但每項(xiàng)都有血淚教訓(xùn)。我印象最深的就是電機(jī)轉(zhuǎn)向反了那一次地面檢查時(shí)沒(méi)看電機(jī)轉(zhuǎn)向直接解鎖起飛飛機(jī)在地上打了個(gè)滾槳葉全廢。關(guān)鍵原因就是反扭矩方向不對(duì)飛控的角速度反饋完全跟不上起飛的那一瞬間姿態(tài)就失控了。從此以后電機(jī)轉(zhuǎn)向檢查成了我的鐵律。4. 常見(jiàn)問(wèn)題與排查技巧實(shí)錄4.1 對(duì)頻失敗、通道反向、油門(mén)不受控的典型修復(fù)我把這幾年遇到的高頻問(wèn)題整理成速查表方便你現(xiàn)場(chǎng)對(duì)照現(xiàn)象可能原因排查與修復(fù)對(duì)頻一直失敗射頻功率過(guò)低、接收機(jī)未進(jìn)入對(duì)頻模式、協(xié)議不匹配把遙控器貼近接收機(jī)再試確認(rèn)協(xié)議一致看說(shuō)明書(shū)是否要先斷開(kāi)電源再按對(duì)頻鍵接收機(jī)已對(duì)頻但飛控?zé)o信號(hào)線序接錯(cuò)、協(xié)議類型未在飛控里設(shè)置、供電不足用萬(wàn)用表確認(rèn)VCC/GND/信號(hào)三線定義在Betaflight接收機(jī)頁(yè)面選擇正確協(xié)議換接收機(jī)供電端口推油門(mén)電機(jī)不轉(zhuǎn)或反轉(zhuǎn)油門(mén)通道反向、電調(diào)未校準(zhǔn)在遙控器里反向油門(mén)通道或在地面站做通道反向重新校準(zhǔn)電調(diào)行程解鎖后電機(jī)怠速抖動(dòng)PID過(guò)高、電調(diào)協(xié)議設(shè)置錯(cuò)誤、電機(jī)軸承問(wèn)題先降低PID的P值觀察是否改善確認(rèn)DShot協(xié)議版本與電調(diào)兼容檢查電機(jī)是否卡阻飛行中突然失控墜落信號(hào)干擾、電池電壓不足、失控保護(hù)未生效檢查飛行記錄儀/黑匣子日志檢查接收機(jī)天線擺放位置確認(rèn)失控保護(hù)模式已正確設(shè)置遙控器已開(kāi)機(jī)但接收機(jī)不亮接收機(jī)供電故障檢查接收機(jī)是否從飛控/分電板正常取電是否有5V輸出這里面最有代表性的是通道反向問(wèn)題。比如你設(shè)置美國(guó)手Mode 2左手油門(mén)、右手俯仰/橫滾結(jié)果裝好飛機(jī)后一推油門(mén)飛控顯示的是橫滾在變化。這個(gè)問(wèn)題的根源在于遙控器通道輸出的物理方向與飛控默認(rèn)期望方向不一致。解決辦法先在地面站看每個(gè)搖桿對(duì)應(yīng)哪個(gè)通道然后對(duì)異常通道做反向操作。千萬(wàn)別想著在飛控里改通道順序去湊那會(huì)引入更大的混亂。4.2 干擾、距離短等環(huán)境類問(wèn)題如果設(shè)備本身沒(méi)問(wèn)題但飛行中總感覺(jué)信號(hào)發(fā)飄、距離拉不遠(yuǎn)那大概率是環(huán)境問(wèn)題。先說(shuō)最常見(jiàn)的天線擺放。發(fā)射機(jī)天線和接收機(jī)天線之間要保持最佳極化方向一致而且天線不要貼地、不要被碳纖維機(jī)身遮住。碳纖維是導(dǎo)電的會(huì)對(duì)無(wú)線信號(hào)形成屏蔽這也是為什么很多穿越機(jī)要把接收機(jī)天線伸出機(jī)身外、用塑料管支撐的原因。第二個(gè)常見(jiàn)問(wèn)題是2.4G頻段擁堵。2.4G頻段不只是遙控器在用Wi-Fi、藍(lán)牙、圖傳的2.4G模式都在搶這個(gè)頻段。飛行現(xiàn)場(chǎng)人多、路由器密集遙控信號(hào)被壓制很正常。如果你在市區(qū)或者比賽現(xiàn)場(chǎng)飛建議優(yōu)先選擇ELRS或Crossfire這類支持900M/2.4G雙頻或跳頻方案的協(xié)議抗干擾能力強(qiáng)很多。實(shí)測(cè)下來(lái)ELRS在同等功率下的鏈路穩(wěn)定性確實(shí)比傳統(tǒng)ACCST強(qiáng)不少尤其是低延遲方面。第三個(gè)問(wèn)題是發(fā)射功率設(shè)置。很多遙控器可以在100mW到1W之間切換射頻功率高功率模式發(fā)熱大、耗電快低功率則距離受限。如果你不是飛遠(yuǎn)航100~250mW足夠如果做超遠(yuǎn)距離飛行再考慮上功放或改高功率協(xié)議。要注意的是各國(guó)對(duì)遙控設(shè)備發(fā)射功率有嚴(yán)格限制玩歸玩別去挑戰(zhàn)法律紅線合規(guī)飛行才是長(zhǎng)久之道。5. 進(jìn)階方向從遙控器到地面站控制器的外延5.1 航點(diǎn)規(guī)劃與數(shù)傳鏈路當(dāng)你不滿足于手動(dòng)操控想讓無(wú)人機(jī)自己飛控制器的概念就延伸到了地面站。以Mission Planner和Pixhawk飛控為例在電腦上畫(huà)一條航線設(shè)定每個(gè)航點(diǎn)的高度、速度和動(dòng)作然后通過(guò)數(shù)傳模塊上傳給飛控飛機(jī)就會(huì)按航線自動(dòng)飛行。這就是超視距控制控制器不再只是你手里的搖桿而是你電腦上的地圖和航線編輯器。數(shù)傳鏈路和遙控鏈路是兩套獨(dú)立的通信系統(tǒng)數(shù)傳負(fù)責(zé)雙向數(shù)據(jù)傳輸航點(diǎn)上傳、遙測(cè)回傳遙控負(fù)責(zé)實(shí)時(shí)操控。在搭建數(shù)傳時(shí)要用不同的頻段或協(xié)議避免互相干擾。我見(jiàn)過(guò)有人把數(shù)傳模塊的915M天線和遙控接收機(jī)天線貼在一起裝結(jié)果一給油門(mén)遙控信號(hào)就掉包后來(lái)把兩根天線拉開(kāi)距離、垂直擺放才解決。這就是典型的射頻布局問(wèn)題值得注意。如果你想接觸這個(gè)方向建議先在地面站模擬器里完整跑一遍航點(diǎn)規(guī)劃流程再把飛機(jī)架在室外安全場(chǎng)地用非常低的航點(diǎn)和慢速做一次真實(shí)飛行測(cè)試。別一上來(lái)就規(guī)劃復(fù)雜航線我最初試飛時(shí)定的航線離樹(shù)太近差點(diǎn)炸機(jī)多虧返航點(diǎn)設(shè)置得比較高。5.2 從商業(yè)成品到自組開(kāi)源我的個(gè)人體會(huì)這些年我從大疆成品玩到自組穿越機(jī)再到Pixhawk開(kāi)源平臺(tái)最大的體會(huì)是控制器的好壞不在于它有多貴而在于你有多了解它。成品機(jī)控制鏈路封閉簡(jiǎn)單穩(wěn)定但出了問(wèn)題你無(wú)法干預(yù)開(kāi)源平臺(tái)控制鏈路完全開(kāi)放可調(diào)參數(shù)極多但一切責(zé)任在你。我的建議是第一臺(tái)無(wú)人機(jī)選成品把安全飛行和操控手感練出來(lái)第二臺(tái)強(qiáng)烈建議自己組一臺(tái)哪怕只是換一套飛控、刷一個(gè)固件你對(duì)控制器三個(gè)字的理解都會(huì)完全不一樣。最后再分享一個(gè)實(shí)用小技巧無(wú)論是遙控器還是飛控固件升級(jí)后一定要重新檢查一遍通道映射和失控保護(hù)。有一次我升級(jí)完遙控器固件所有模型參數(shù)被重置幸好起飛前試了試搖桿發(fā)現(xiàn)通道全亂了。從那以后每次升級(jí)固件我都強(qiáng)制自己完整走一遍對(duì)頻—搖桿校準(zhǔn)—通道檢查—失控保護(hù)測(cè)試四步流程逼出來(lái)的習(xí)慣穩(wěn)得很。本文還有配套的精品資源點(diǎn)擊獲取