倒立擺姿態(tài)精確調(diào)整與控制系統(tǒng)（代碼、機械結構模塊）

倒立擺姿態(tài)精確調(diào)整與控制系統(tǒng)概述：

       本系統(tǒng)將倒立擺原理用于火箭回收降落過程中的姿態(tài)調(diào)整，開創(chuàng)了全新的回收火箭方案。系統(tǒng)采用STM32F103為主控，基于轉動慣量守恒，完成了將火箭核心動力機構，采用高性能伺服系統(tǒng)和動量輪實現(xiàn)了對姿態(tài)的精準調(diào)整。

視頻演示：

        本系統(tǒng)采用兩個高速旋轉的動量輪對火箭的姿態(tài)進行控制，兩動量輪軸線相互垂直，并與火箭軸線方向垂直，以滿足火箭在任意姿態(tài)下，對其姿態(tài)的恢復。如圖所示：

主控系統(tǒng)電路設計：

根據(jù)動量輪快速控制的需求，控制核心部分采用STM32F103作為MCU，且有SWD接口方便前期程序調(diào)試。采用IAP模式進行無線系統(tǒng)燒錄，便于后期火箭模型實測時的程序修改。

動量輪驅動模塊設計：

動量輪用來調(diào)整系統(tǒng)姿態(tài)，對于動量輪的快速控制響應、高速控制要求極高。因此電機必須具有良好的動態(tài)響應性能，同時轉動扭矩也應足夠大滿足轉動需求。因此選擇瑞士Maxon的直流無刷電機251601外轉子馬達作為系統(tǒng)動量輪的主要驅動裝置。

無線通訊模塊電路設計：

無線模塊主要用于系統(tǒng)調(diào)試過程中火箭模型的狀態(tài)數(shù)據(jù)回傳，便于快速高效的調(diào)試拋擲在空中的控制系統(tǒng)，能夠根據(jù)藍牙無線模塊傳回的狀態(tài)數(shù)據(jù)適當更改控制算法和修正控制模型。

 動量輪快速制動模塊

動量輪快速制動部分相當于一個剎車裝置，通過該剎車裝置可以快速實現(xiàn)動量輪卡頓剎車，從而實現(xiàn)瞬時極大動量的轉變來大幅度調(diào)整火箭姿態(tài)。根據(jù)對于數(shù)據(jù)參數(shù)的計算，選擇GOTECK的金屬齒輪舵機GS-9025MG。

姿態(tài)儀AHRS功能架構圖：

作品實物圖展示：