摘要

The cooperative navigation and localization technology of multi-USVs is an important way to solve the navigation problem in complex environment. For the cooperative navigation and localization of multi-USVs with leader-follower structure, a state space model of cooperative localization is built, and then a linear model is obtained by expanding the nonlinear model around filter value. An extended Kalman filter is designed to fuse the sensor information to locate the slave USV in real time. At last, the relationship among USV distances, angle and accuracy is researched, and the observability analysis of cooperative navigation filter algorithm is done with Lie algebra. The results show that the navigation accuracy is improved effectively by controlling the variations of distances and angles of leader and slave USVs between two adjacent moments, which is verified by simulation and experiment.

全文