Multisensor-Based Navigation and Control of a Mobile Service Robot

Abstract

Service robot navigation must take the humans into account explicitly so as to produce motion behaviors that reflect its social awareness. Generally, the navigation problems of mobile service robot can be summarized to three aspects: 1) human detection; 2) robot real-time localization; and 3) robot motion planning. The purpose of this paper is to provide a feasible strategy to integrate these three aspects to achieve a conscious, safe, accurate, robust, and efficient navigation. We first introduce the human detection system for recognition of human gesture using a weighted dynamic time warping (DTW) with kinematic constraints. Thus, by interpreting the human body language through gesture recognition, robot motion behaviors like heading to the assigned position or following people can be activated. Then, for the robot localization, a simultaneous localization and mapping (SLAM) method based on artificial and natural landmark recognition is employed to provide absolute position feedback in real time. For the motion planning, a novel quadrupole potential field (QPF) method is proposed to plan collision-free trajectories, adequately considering the nonholomic constraint of the mobile robot system. Then, a robust kinematic controller is designed for trajectory tracking to account for slip disturbances. Such a design automatically merges path finding, trajectory generation, and trajectory tracking in a closed-loop fashion, achieving simultaneous motion planning for obstacle avoidance and feedback stabilization to a desired position and orientation even in the presence of slippage. Finally, experiments prove the effectiveness and feasibility of the proposed strategy, showing a good navigation performance on mobile service robot.