This algorithm can realize linear minimum mean square error estimation of yaw rate, and on-line estimate statistical characteristic of system noise and observation noise during vehicle running.
According to the time error, the yaw maneuvering command was generated and route dynamic planning on the basis of the pre-determined route was done to control the impact time.