一种四旋翼飞行器的航向轴角速度估计方法
摘要:
本发明公开了一种四旋翼飞行器的航向轴角速度估计方法,首先,采集多组传感器数据,通过最小二乘法辨识扭矩模型参数,取平均作为模型参数估计的初值;其次,周期读取k时刻四旋翼飞行器机载传感器信息,并计算k时刻的扭矩模型;然后,预测k时刻四旋翼飞行器的航向轴角速度、扭矩模型的一阶马尔可夫、扭矩模型参数及四元数;最后,通过扩展卡尔曼滤波器,对k时刻四旋翼飞行器的航向轴角速度、四元数进行校正。该方法无需增加外部设备,可以在缺少航向轴角速度传感器时,通过扭矩模型辅助获得航向角速度估计。
公开/授权文献
0/0