Open Source Robotics

精選高品質的開源機器人專案、工具與軟體,推動機器人社群向前發展。

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 加入垂直速度控制

將油門對應到目標垂直速度。以速度阻尼實作定高。

本網站需要 JavaScript 才能正常運作。請啟用 JavaScript 以瀏覽我們的開源機器人專案。