The invention discloses a position and posture
estimation method of a driverless car based on a distance from a point to a surface and cross
correlation entropy rectification, which comprises the following steps: firstly, a three-dimensional
laser radar is calibrated, and then the acquired three-dimensional
laser radar data is subjected to coordinate conversion;
point cloud alignment is carried out on the acquired data and the existing map data to obtain a rotary and translation transformation of a
rigid body; so that the position and posture of an active
moving body are obtained according tothe rotary and translation conversion. According to the invention, by using the three-dimensional
laser radar as the
data source, the function of estimating the position and posture of the driverlesscar is finished through the steps of coordinate
system conversion, data drop sampling,
point set rectification and the like. The method can well overcome the influence of weather, light and other environmental factors. Moreover, the error
evaluation function based on the distance from the point to the surface and the cross
correlation entropy has good resistance to
noise and abnormal points, suchas mismatching of the scene and the map description part, dynamic obstacles and the like, therefore, the function of accurate and robust
estimation of the position and posture of the driverless car can be achieved.