Trajectory prediction algorithm based on improved polynomial curve fitting
Aiming at the problem that the traditional polynomial curve fitting trajectory prediction algorithm is not accurate enough for complex and changeable trajectory prediction,an improved polynomial curve fitting trajectory prediction algorithm is proposed.Firstly,the curvature and torsion thresholds of the trajectory are obtained.Secondly,the trajectory parts with larger prediction errors are identified by the thresholds above,and the interpolation rolling prediction algorithm is used for prediction.Finally,the double errors predictive value update algorithm is used to update the predicted value.Simulation results show that compared with the traditional polynomial curve fitting trajectory prediction algorithm,the average displacement error(ADE)of the proposed algorithm decreases by 42.77%.The final displacement error(FDE)reduces by 36.62%,which verifies the feasibility and the effectiveness of the proposed algorithm.