Abstract-This paper presents an approach to time-optimal kinodynamic motion planning for a mobile robot. A global path planner is used to generate collision-free straight-line paths from the robot's position to a given goal location. With waypoints of this path, an initial trajectory is generated which defines the planned position of the robot over time. A velocity profile is computed that accounts for constraints on the velocity and acceleration of the robot. The trajectory is refined to minimize the time needed for traversal by an any-time optimization algorithm. An error-feedback controller generates motor commands to execute the planned trajectory. Quintic Bézier splines are used to allow for curvature-continuous joins of trajectory segments, which enables the system to replan trajectories in order to react to unmapped obstacles. Experiments on real robots are presented that show our system's capabilities of smooth, precise, and predictive motion.
I. INTRODUCTIONMotion planning is a fundamental task for wheeled mobile robots. It consists of planning a path from the robot's position to a given goal location using a representation of the environment, and computing motion commands that make the robot platform follow this path [1]. Most traditional motion planning systems use a global path planner like A* or its descendants, e.g., [2], [3], [4], which find the shortest path on a 2D grid or graph that represents the traversable space. These paths typically contain sharp corners and can only be accurately followed by stopping and turning on the spot, which significantly increases the time of travel.The generation of actual motor commands is therefore often carried out by reactive systems [5], [6], [7]. These consider the vector to the next one or two waypoints in the planned path and the distance to obstacles perceived by the robot's sensors. The Dynamic Window [8] additionally considers the platform's kinodynamic constraints. All of these approaches have in common that the robot deliberately deviates from the planned path to drive smooth curves, which leads to faster progress towards the goal location.The downside of this solution is, that (a) optimality properties of the straight line path do not apply to the resulting continuous trajectory and no time of travel optimality is achieved, (b) the shape of the path, e.g., how much corners are cut, depends on parameter settings rather than optimization or search, (c) velocities and accelerations are not planned in advance but subject to reactive behavior, which prevents accurate motion prediction and makes satisfaction of hard constraints difficult, and (d) no guarantees can be made for the control stability or convergence behavior of the system.