|
htbaoyufei 发表于 2023-3-14 14:49
有个想法啊,我在思考这套系统能不能加入一些传感器的接入接口?比如说GPS、转速计……,比如说知道是熄火 ...
控制模型就是读入接收机数据,解码,确定指令(正常飞还是救机还是自稳),如果正常飞就原封不动将数据包传给陀螺仪,如果是其它指令就根据实时状态计算各通道的值,再从新编码,生成对应协议的数据包发给陀螺仪,就相当于截断接收机信号,自己生成信号控制飞机
另外由于陀螺仪是一个优秀的角速度环控制系统,那么我这个东西就只需要实现位置-角度再到角速度的闭环控制,比如根据水平位置-速度的pid,生成机身倾角的期望值,然后倾角的闭环控制又生成角速度的期望值,然后就生成对应的通道控制量,高度控制也是类似的
控制流和框架逻辑和多轴确实有很多不一样的,姿态解算基本是自己弄的,尤其是滤波方面,试了很多方案,现在用的是动态陷波滤波,还有多轴的万向节锁死问题也解决了。
|
来自安卓客户端
|