A Fusion Navigation System of Security Robot Based on Millimeter Wave Radar and Inertial Sensor

In smog and dust environments, vision and laser-based navigation methods can not be used effectively for controlling the movement of a robot. Autonomous operation of a security robot can be achieved in such environments by using millimeter wave (MMW) radar for the navigation system. In this study, an approximate center method under sparse point cloud is proposed, and a security robot navigation system based on millimeter wave radar is constructed. To improve the navigation accuracy of the robot, inertial navigation of the robot is integrated with MMW radar. Based on the concept of inertial navigation, the state equation for the motion principle of the robot is deduced. According to principle of MMW navigation, the measurement equation is derived, and the kinematics model of the robot is constructed. Further, by applying the Kalman filtering algorithm, a fusion navigation system of the robot based on MMW and inertial navigation is proposed. The experimental results show that the navigation error is close to the error of the navigation system with only MMW in the initial stage. With iterations of the filtering algorithm, the gain matrix converges gradually, and the error of the fusion navigation system decreases, leading to the stable operation of the robot. The localization error of the fusion navigation system is approximately 0.08 metre, and the navigation accuracy is better than that of the navigation system with only MMW radar.