技术总结
本发明一种基于卡尔曼滤波的小型运输器姿态控制方法,控制成本低,可以主动进行变轨,提高飞行精度。包括以下步骤:S1、通过小型运输器上的陀螺仪获得小型运输器当前的三轴角度以及三轴角速度;S2、通过陀螺仪滤波对获取的小型运输器当前的三轴角度数据进行处理,得到小型运输器当前稳定的三轴角度;S3、采用动态的卡尔曼滤波算法对获取的小型运输器当前的三轴角速度数据进行处理,得到小型运输器当前稳定的三轴角速度;S4、将所述的稳定的三轴角度和三轴角速度作为PID控制器的输入信号,经过PID控制器处理得到小型运输器的舵面偏转角度;S5、将小型运输器的舵面偏转角度转化成PWM信号并输送给相应的舵机,舵机动作从而调整小型运输器的飞行姿态。
技术研发人员:何湘远;陈浩南;
受保护的技术使用者:哈尔滨模豆科技有限责任公司;
技术研发日:2018.01.11
技术公布日:2018.06.19