VFO feedback control using positively-invariant funnels for mobile robots travelling in polygonal worlds with bounded curvature of motion

Feedback control of mobile robots guaranteeing preservation of state constraints resulting from obstacles in the environment and input constraints imposed by robot mechanical construction is essential in practical applications of robotic systems. The safety of motion execution is often ensured by a strategy of driving the robot through a sequence of funnels representing safe, positively invariant subsets of robot configuration space for utilized feedback control laws. In this paper, the VFO (Vector Field Orientation) control law is leveraged to develop such a feedback control strategy for a unicycle robot with bounded curvature of motion. The proposed definition of funnels arises naturally from analysis of the VFO control law under curvature constraints. Obstacles in the environment are handled by shrinking the funnels using additional artificial curvature constraints. An exact analytic method for computation of funnels is presented. To make the funnels positively-invariant and guarantee motion safety, the original VFO control law has been modified. In contrast to numerous methods available in the literature, proposed feedback control strategy ensures at least C1 continuity of the control signals during transitions between funnels. Effectiveness of our approach has been verified by simulations, during which the robot was driven through a sequence of funnels planned in the cluttered environment using the RRT* algorithm.

[1]  Howie Choset,et al.  Integrating planning and control for single-bodied wheeled mobile robots , 2011, Auton. Robots.

[2]  Russ Tedrake,et al.  Feedback-motion-planning with simulation-based LQR-trees , 2016, Int. J. Robotics Res..

[3]  Krzysztof Kozlowski,et al.  Motion planning and feedback control for a unicycle in a way point following task: The VFO approach , 2009, Int. J. Appl. Math. Comput. Sci..

[4]  Vijay Kumar,et al.  Sequential Composition for Navigating a Nonholonomic Cart in the Presence of Obstacles , 2011, IEEE Transactions on Robotics.

[5]  Benjamin Kuipers,et al.  Feedback motion planning via non-holonomic RRT* for mobile robots , 2015, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[6]  Denny Oetomo,et al.  System of funnels framework for robust global non-linear control , 2016, 2016 IEEE 55th Conference on Decision and Control (CDC).

[7]  Steven M. LaValle,et al.  Smooth Feedback for Car-Like Vehicles in Polygonal Environments , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[8]  Daniel E. Koditschek,et al.  Sequential Composition of Dynamically Dexterous Robot Behaviors , 1999, Int. J. Robotics Res..

[9]  Maciej Michalek,et al.  VFO stabilization of a unicycle robot with bounded curvature of motion , 2015, 2015 10th International Workshop on Robot Motion and Control (RoMoCo).

[10]  Hadas Kress-Gazit,et al.  Synthesis of nonlinear continuous controllers for verifiably correct high-level, reactive behaviors , 2015, Int. J. Robotics Res..