Carbon Aeronautics Quadcopter 組裝指南
從零打造四旋翼無人機,從中學習航空學、電子學與程式設計
授權條款
MIT
組裝指南
1. 入門
設定 Teensy 4.0 微控制器。安裝 Arduino IDE 與 Teensyduino。焊上排針。
1.1 安裝開發工具
安裝 Teensy Loader、Arduino IDE 1.8.16 與 Teensyduino 1.55
1.2 測試微控制器
透過 USB 連接 Teensy 4.0,上傳並測試 blink 範例程式
1.3 焊接排針
在 Teensy 4.0、MPU-6050 與 BMP280 轉接板上焊接公排針
1.4 組裝 LED 電路
在麵包板上將綠色 LED 接到 pin 6、紅色 LED 接到 pin 5,並串接電阻
1.5 組裝分壓電路
將 2S LiPo 經分壓電路接到類比 pin 15,用於監控電池
2. 感測器設定
透過 I2C 連接 MPU-6050 陀螺儀並撰寫程式。校正陀螺儀偏移量。
2.1 透過 I2C 連接 MPU-6050
將 SDA/SCL 接到 Teensy。將 I2C 設為 400 kHz。
2.2 讀取陀螺儀資料
設定陀螺儀暫存器,讀取原始資料,並轉換為滾轉/俯仰/偏航的度/秒
2.3 校正陀螺儀
開機時記錄 2000 筆量測值,計算平均偏移量,再從讀值中減去
3. 馬達與接收機控制
透過 PWM 測試 ESC/馬達控制,連接 PPM 接收機,並透過 Teensy 控制馬達。
3.1 直接測試 ESC
以 PWM 模式將 ESC 接到接收器第 3 通道。確認能從發射器控制馬達。
3.2 連接 PPM 接收器
將 FS-iA6B 接收器的 PPM 接到 Teensy pin 14。透過 PulsePosition 函式庫讀取 6 個通道。
3.3 透過 Teensy 控制馬達
將 PWM 設為 250 Hz、12 位元解析度。將接收器油門對應到馬達輸出。
4. 電池管理
製作高側電源開關電路、加入電壓偵測,並實作電池監控。
4.1 組裝電源開關電路
將 BTS50080-1TMB 高側開關與滑動開關接線,用於 ON/OFF 控制
4.2 加入電流感測
接上電壓感測線路,用於量測電流與追蹤電池百分比
4.3 實作電池監控
撰寫低電量 LED 警示程式(<=30% 時亮紅色 LED)
5. 組裝四軸無人機
實體組裝:安裝 ESC、馬達、螺旋槳、接收機與電池,並焊接 PCB 機架上的電子元件。
5.1 將 ESC 安裝到下機架
將 4 個 ESC 裝到下方 PCB 機架,並用 M3x6mm 螺絲安裝 4 根機架間隔柱
5.2 安裝馬達與螺旋槳
用 M2x4mm 螺絲裝上 4 顆馬達,再用 M2x8mm 螺絲裝上 CW/CCW 螺旋槳
5.3 安裝接收器與電池
用束線帶固定接收器,用綁帶固定電池,並保護好纜線
5.4 焊接上機架電子元件
在上方 PCB 焊上排針、開關、電阻、二極體、LED 與 XT60 接頭
5.5 安裝感測器
用 M3x20mm 螺絲、防鬆螺帽與一般螺帽安裝 MPU-6050 與 BMP280
5.6 接合上下機架
將 ESC 電源線穿過上方 PCB 的孔並焊接,再以間隔柱連接
5.7 測試所有系統
用三用電錶檢查連線。透過 USB 通電。測試感測器、接收器與馬達。
6. 飛行控制器:角速率模式
為滾轉、俯仰、偏航實作 PID 角速率控制器。以角速率模式進行首次飛行。
6.1 實作 PID 控制器
整合所有程式碼:陀螺儀、接收器、馬達、電池。為滾轉/俯仰/偏航角速度加入 PID。
6.2 加入安全功能
積分飽和保護(400us 上限)、馬達限制(1180-2000us)、油門低於 1050us 時切斷
6.3 設定發射器失控保護
設定發射器的失控保護值
6.4 以角速度模式首次飛行
試飛。PID 值:P_roll/pitch=0.6、I=3.5、D=0.03、P_yaw=2、I_yaw=12
7. 飛行控制器:自穩模式
加入用於角度估測的卡爾曼濾波器。實作串級 PID,實現自動水平飛行。
7.1 量測角度
積分陀螺儀角速度求得角度。用加速度計的三角函數求滾轉/俯仰。比較兩種方法。
7.2 實作 1D 卡爾曼濾波器
結合陀螺儀積分預測與加速度計量測,求得穩定的角度
7.3 加入角度模式 PID 迴路
實作串級 PID:外層角度迴路輸入內層角速度迴路。自動維持水平飛行。
8. 飛行控制器:速度模式
加入氣壓計高度量測、2D 卡爾曼濾波器與垂直速度控制。
8.1 加入高度量測
連接 BMP280 氣壓計。將氣壓讀值換算為高度。
8.2 實作 2D 卡爾曼濾波器
在 2D 狀態向量中結合 BMP280 高度與加速度計的垂直加速度
8.3 加入垂直速度控制
將油門對應到目標垂直速度。以速度阻尼實作定高。