今天本來也沒做好起飛的準(zhǔn)備,不過感覺老是在屋里調(diào)有些東西是觀察不到的,因此就冒險(xiǎn)去戶外飛了一下。果然。。。。。。墜機(jī)了,原因是其中一個非自緊螺旋槳的螺絲松了,稍后上圖,之前也松過一次,沒處理好,這次得到教訓(xùn)了。這一摔就是400塊錢沒了,維修也得1到2個星期。
目前的功能:
- 1.開啟傳感器低通濾波98Hz,濾掉電機(jī)震動對加速度計(jì)和陀螺儀的影響。
- 2.磁力計(jì)現(xiàn)場校準(zhǔn),代碼直接完成,不需要PC干預(yù)。換個地方飛不用再帶個電腦做校準(zhǔn)了。
- 3.陀螺儀零偏自校準(zhǔn)
- 4.加速度計(jì)零偏和靈敏度校準(zhǔn)
- 4.代碼時間片管理,姿態(tài)融合500Hz,PID控制200Hz
- 5.位置式PID控制,控制參數(shù)采用kp,Ti,Td,從今天飛行狀況來看,此功能日后需大力改進(jìn)
- 6.固定航向模式。日后加入可控航向。
- 7.串口在線調(diào)試,支持在線參數(shù)保存和讀取,采用GD32F103內(nèi)部Flash來保存參數(shù),不用外擴(kuò)存儲芯片,也方便調(diào)試PID參數(shù)和磁力計(jì)校準(zhǔn)。
- 8.飛行模式:x模式
自己設(shè)計(jì)的飛控板第二版,兼容F10x/F2xx/F4xx系列MCU,正面:外擴(kuò)4個PWMin外接遙控接收機(jī),4個PWMout外接motor,4個PWM備用,1個DCMI攝像頭接口,1個USART1接藍(lán)牙模塊,1個SPI可接SPI nand。外接TF卡用于存儲視頻
整機(jī):兩個白色軸中間是機(jī)頭,右邊白色軸上是之前做的藍(lán)牙模塊,整機(jī)標(biāo)配:450機(jī)架,980kv電機(jī),好盈20A電調(diào),11.1V-3S動力電池,7通道接收機(jī),鋰電池低壓報(bào)警器,槳1047
PID分兩種位置式和增量式,我采用的是位置式,將Ki和Kd用Ti和Td的形式來表達(dá),并帶入到式2-3中,ek=角度的期望-傳感器輸出的角度,所用的PID三個參數(shù)是:Kp、Ti、Td。
公式如圖所示:
四軸PID控制的目的就是將接收到的遙控的控制信號(一般有油門THR、升降舵ELE(對應(yīng)pitch)、副翼Ail(對應(yīng)roll)、方向舵RUD(對應(yīng)yaw))與飛控板本身計(jì)算得出pitch、roll、yaw做比較,分別得出它們之間的誤差值,然后將Kp、Ti、Td與這個誤差值結(jié)合得出PID輸出(PID_pitch、PID_roll或者PID_yaw),再將這三個PID輸出與油門結(jié)合在一起算出送到每一個電調(diào)的PWM數(shù)值,從而控制每一個電機(jī)的轉(zhuǎn)動。