估计从UUV航行参数的混合坐标系下的EKF算法

在主从式UUV 协作系统中，由于定位和导航的需要，要求尽快估计出从UUV 的航行参数，但通常所用的递推最小二乘（RLS）算法，其初始方位测量对滤波结果影响大且存在收敛速度慢、计算精度低的缺点，难以满足应用需求，而推广卡尔曼滤波（EKF）算法能较好地克服上述问题。在直角坐标系下（CEKF），方位信息与距离信息相互耦合导致初始振荡剧烈，改为混合坐标系（MEKF）后问题得到了极大的改善。最后，通过仿真及现场试验验证了此改进方法的有效性。