A High-Order Kalman Filter Method for Fusion Estimation of Motion Trajectories of Multi-Robot Formation