一种基于互补滤波的水下滑翔器节能算法
摘要:
本发明提出一种基于互补滤波的水下滑翔器节能方法,该方法通过多普勒计程仪实时采集水下滑翔器的速度信息;根据速度信息判断水下滑翔器的运动状态;当水下滑翔器处于高动态,则开启加速度计和陀螺仪,通过互补滤波融合磁力计和IMU的信息,以提高导航精度;否则,关闭加速度计和陀螺仪,仅通过多普勒计程仪和磁力计完成导航;本发明通过选择性地开启和关闭IMU提高了水下滑翔器的工作时间和续航能力;另外,采用创新的互补滤波信息融合算法提高了滑翔器导航系统的工作精度,保证了在IMU开启后对没有IMU推算导航的精度提升。
公开/授权文献
0/0