一点点想法:
1. 首先你要确定如何输入这个2米高度指令,如果你有数传电台,可以直接输入到飞控,如果没有,可以用遥控器油门摇杆输入,当然摇杆没法直接输入一个绝对高度,这时可以用一个累加数H来作为高度指令,累加数H初始值为零,代表高度为零,当油门往上推时,累加数根据推的幅度来累加,油门中立点往下时,累加数减少,最小为零。这样就可以得到一个高度指令了。
2. 高度测量,超声波传感器得到一个高度信号h后,与输入指令H作负反馈,得到一个偏差n,用n进行PID 运算后得到一个控制信号D作为四旋翼新的上升下降输入
3. 人工定高切换到超声波定高,算法要考虑到切换要平顺,超声波定高时,要考虑到最小测量值以下时的控制,与超出量程时的方案
以上未经证实的想法,不一定准确或者一定不准确,仅作探讨。
|