一种无人艇导航方法
Abstract:
本发明公开了一种无人艇导航方法,使用IMU反馈的角度对无人艇进行航向角的闭环控制,引入UWB的定位数据,使无人艇先定当前角度航行一个时间间隔,记录下航行前和时间间隔后的位置坐标,通过两组坐标求解航行的真实角度值,使用卡尔曼滤波的方式融合IMU的陀螺仪数据和坐标点的角度值,最终使用串级积分分离PID算法进行无人艇的航向航速控制,使得无人艇航行过程的精确稳定。本发明通过卡尔曼滤波器融合IMU的漂移航向角度值与UWB的精确位置值,解决了水池条件下小型无人艇由于航向角漂移导致的导航困难问题。本发明硬件实现成本极低,是低成本无人艇水池导航实验较优选择。
Public/Granted literature
Patent Agency Ranking
0/0