DIY一款具運(yùn)動狀態(tài)追蹤功能的遙控玩具，做守護(hù)天使
加入技術(shù)交流群
3.4.3 飛機(jī)的控制算法
圖9 系統(tǒng)控制算法結(jié)構(gòu)框圖
假設(shè)兒童是一個有一定大小的點(diǎn)，即可以在三維空間內(nèi)自由運(yùn)動。根據(jù)測得的加速度可以得到兒童的速度和位移?？紤]到測量過程中重力加速度的影響，通過加速度計(jì)算得到速度和位移的最基本方程為：
其中*代表絕對坐標(biāo)系 X，Y，Z 軸向中的任意一個，v0，s0分別是初始速度和位移，t0是測量開始時間，te是測量終止的時間。在測量中只需要測量 X，Y，Z三個軸向上的加速度以及運(yùn)動的起始和終止時間t0，te就可以得到三個軸向上的速度和位移特征。
如果數(shù)據(jù)采集周期 T 很小，則在 ? t 時間內(nèi)可以認(rèn)為其運(yùn)動狀態(tài)為勻速運(yùn)動，通過 X、Y 方向的位移計(jì)算可以求ψ、θ 角，從而可以控制飛機(jī)的轉(zhuǎn)彎飛行等。
圖10 系統(tǒng)數(shù)據(jù)采集模塊運(yùn)動示意圖
.jpg)
評論