Feedback Control for Collision-Free Nonholonomic Vehicle Navigation on SE(2) With Null Space Circumvention

Abstract

In this article, we present a novel feedback controller for the collision-free navigation of a class of nonholonomic vehicles based on navigation functions in convex environment. This controller utilizes a high-level principle— <italic xmlns:mml="http://www.w3.org/1998/Math/MathML" xmlns:xlink="http://www.w3.org/1999/xlink">null space circumvention</i> —in nonholonomic navigation control, allowing us to involve different vehicle kinematics and navigation functions with respect to the task and environment. For a single vehicle, we have proved that the controller can steer it to the target on SE(2) while avoiding collision from almost all the initial states. The controller can also close the gap between holonomic vehicle navigation and nonholonomic vehicle navigation, allowing the navigation functions created for holonomic vehicles to be used for nonholonomic vehicles. Furthermore, we extend the controller to multivehicle formation control. Within this task, our controller shows generality without much modification except for updating the gradient of the chosen navigation functions. Simulation and experimental results demonstrate that the proposed controllers can achieve collision-free navigation for a single vehicle and multiple vehicles.