DIY一款具運動狀態(tài)追蹤功能的遙控玩具，做守護天使
加入技術交流群
3.3系統(tǒng)軟件架構(gòu)
軟件系統(tǒng)分為四個模塊：
（1）通訊模塊實現(xiàn)對無線通訊模塊的傳感信號的收發(fā)；
（2）運動模塊實現(xiàn)對電機、電調(diào)的驅(qū)動，使電機按照指定的方向和速率轉(zhuǎn)動，實現(xiàn)對飛機的控制；
（3）運動控制模塊，通過參考當前的運動狀態(tài)，通過選擇合適的運動控制算法，控制電機的運動狀態(tài)進而控制飛機的運動狀態(tài)；
（4）主模塊，通過合理的算法和調(diào)用，實現(xiàn)各個子模塊之間的配合，完成系統(tǒng)的功能，滿足系統(tǒng)的要求。
圖6 軟件系統(tǒng)各子模塊
3.4 系統(tǒng)軟件流程
3.4.1通訊系統(tǒng)軟件系統(tǒng)框架設計
根據(jù)STM32F103RE處理器特點，本系統(tǒng)采用ZigBee模塊作為無線接收器，串口對無線收發(fā)模塊收一發(fā)狀態(tài)轉(zhuǎn)換的控制。處理器控制信號流程圖如圖 7所示。
圖7 處理器控制信號流程圖
3.4.2 軌跡計算流程圖
軌跡計算總流程如圖8所示，首先由MCU調(diào)用軌跡計算子程序，在子程序中判斷該時刻是否為初始時刻，若該時刻為初始時刻則將速度和位移初始化；若該時刻為非零T時刻，則通過一定的數(shù)據(jù)處理算法以及T-1時刻的速度和位移數(shù)據(jù)來獲得T時刻的速度和位移。
圖8 軌跡計算流程圖
.jpg)
評論