A Navigation System for Autonomous Robot Operating in Unknown and Dynamic Environment: Escaping Algorithm

Abstract—In this study, the problem of navigation in dynamic and unknown environment is investigated and a navigation method based on force field approach is suggested. It is assumed that the robot performs navigation in unknown environment and builds the map through SLAM procedure. Since the moving objects' location and properties are unknown, they are identified and tracked by Kalman filter. Kalman observer provides important information about next paths of moving objects which are employed in finding collision point and time in future. In the time of collision detection, a modifying force is added to repulsive and attractive forces corresponding to the static environment and leads the robot to avoid collision. Moreover, a safe turning angle is defined to assure safe navigation of the robot. The performance of proposed method, named Escaping Algorithm, is verified through different simulation and experimental tests. Besides, comparison between Escaping Algorithm and Probabilistic Velocity Obstacle (PVO), based on computational complexity and required steps for finishing the mission is provided in this paper. The results show Escaping Algorithm outperforms PVO in term of dynamic obstacle avoidance and complexity as a practical method for autonomous navigation.