分布式多微控器雙軸伺服馬達位置控制之應用

Application of a Distributed Multi-Microcontroller Based Two-Axis Servo Motor Position Control

李貫峰(Kwun-Fung Li)

指導教授 ： 蕭照焜

淡江大學/工學院/航空太空工程學系碩士班/碩士(2014年)

https://doi.org/10.6846/TKU.2014.00852

摘要

本論文以分布式之多微控制器系統為基礎，建立以雙軸伺服馬達為致動器之即時控制系統，應用於位置控制上。首先，由微控制器負責計算飛行載具的姿態變化，取得姿態角數據後發出控制命令給致動器做反饋之位置控制。 論文架構分為硬體之實作與軟體撰寫，硬體實作部分為設計伺服馬達控制系統之印刷電路板；而軟體撰寫部分則是使用羅德里格參數結合無跡卡曼濾波做為飛行姿態角計算之演算法，並使用Ｃ語言做為程式撰寫。論文中針對伺服馬達轉動的角度及反應速率以實驗來驗證系統的可行性。最後並比較使用四元數與羅德里格參數執行姿態角計算的比較分析。

關鍵字

雙軸伺服馬達 ； 羅德里格參數 ； 無跡卡曼濾波

並列摘要

This thesis focuses on the design of a dual-axis servo motor position control using a multi-microcontroller architecture. The position command (attitude of the air vehicle) is computed by the multi-microcontroller system. The thesis mainly consists of hard design (servo motor control board), software design, and attitude computation. Rodrigues Parameters based unscented Kalman filter using C language is implemented in this embedded design for attitude determination. Position control and speed of response of the servo motor is verified through experiments using the finished system. Comparison of attitude computation using quaternion based and Rodrigues Parameters based unscented Kalman filters is also addressed in the thesis.

並列關鍵字

Two-axis servo motor ； Rodrigues Parameters ； Unscented Kalman Filter

參考文獻

[4] 吳宗興, 以微機電系統為基礎之飛行資訊量測組件設計與製作，淡江大學航太系碩士班碩士論文, 民國97年6月.

[7] 彭誌宇, 採用羅德里格參數進行姿態計算之研究，淡江大學航太系碩士班碩士論文, 民國101年7月.

[8] 洪為勝, 分布式多微控器系統發展環境設計，淡江大學航太系碩士班碩士論文,民國103年1月.

[6] 王亦強, 非線性卡曼濾波器於飛行姿態計算之研究，淡江大學航太系碩士班碩士論文,民國100年6月.

[10] EKSTRAND, Bertil. Equations of motion for a two-axes gimbal system.Aerospace and Electronic Systems, IEEE Transactions on, 2001, 37.3: 1083-1091.