On the Minimum-Time Control Problem for Differential Drive Robots with Bearing Constraints

This paper presents a study of analysis of minimum-time trajectories for a differential drive robot equipped with a fixed and limited field-of-view camera, which must keep a given landmark in view during maneuvers. Previous works have considered the same physical problem and provided a complete analysis/synthesis for the problem of determining the shortest paths. The main difference in the two cost functions (length vs. time) lays on the rotation on the spot. Indeed, this maneuver has zero cost in terms of length and hence leads to a 2D shortest path synthesis. On the other hand, in case of minimum time, the synthesis depends also on the orientations of the vehicle. In other words, the not zero cost of the rotation on the spot maneuvers leads to a 3D minimum-time synthesis. Moreover, the shortest paths have been obtained by exploiting the geometric properties of the extremal arcs, i.e., straight lines, rotations on the spot, logarithmic spirals and involute of circles. Conversely, in terms of time, even if the extremal arcs of the minimum-time control problem are exactly the same, the geometric properties of these arcs change, leading to a completely different analysis and characterization of optimal paths. In this paper, after proving the existence of optimal trajectories and showing the extremal arcs of the problem at hand, we provide the control laws that steer the vehicle along these arcs and the time-cost along each of them. Moreover, this being a crucial step toward numerical implementation, optimal trajectories are proved to be characterized by a finite number of switching points between different extremal arcs, i.e., the concatenations of extremal arcs with infinitely many junction times are shown to violate the optimality conditions.

[1]  Suresh P. Sethi,et al.  A Survey of the Maximum Principles for Optimal Control Problems with State Constraints , 1995, SIAM Rev..

[2]  Pablo Pedregal,et al.  Existence Results for Optimal Control Problems with Some Special Nonlinear Dependence on State and Control , 2009, SIAM J. Control. Optim..

[3]  Devin J. Balkcom,et al.  for Differential-Drive Mobile Robots , 2009 .

[4]  Bernhard P. Wrobel,et al.  Multiple View Geometry in Computer Vision , 2001 .

[5]  L. Shepp,et al.  OPTIMAL PATHS FOR A CAR THAT GOES BOTH FORWARDS AND BACKWARDS , 1990 .

[6]  Pablo Pedregal,et al.  Existence results for optimal control problems with some special non-linear dependence on state and control , 2009, Proceedings of the 48h IEEE Conference on Decision and Control (CDC) held jointly with 2009 28th Chinese Control Conference.

[7]  F. Clarke Functional Analysis, Calculus of Variations and Optimal Control , 2013 .

[8]  Stergios I. Roumeliotis,et al.  Robot-to-Robot Relative Pose Estimation From Range Measurements , 2008, IEEE Transactions on Robotics.

[9]  Andrea Cristofaro,et al.  Epsilon-Optimal Synthesis for Unicycle-Like Vehicles With Limited Field-of-View Sensors , 2015, IEEE Transactions on Robotics.

[10]  H. Maurer On Optimal Control Problems with Bounded State Variables and Control Appearing Linearly , 1975, Optimization Techniques.

[11]  Negash G. Medhin,et al.  Nonlinear Optimal Control Theory , 2012 .

[12]  Nicholas R. Gans,et al.  A Stable Vision-Based Control Scheme for Nonholonomic Vehicles to Keep a Landmark in the Field of View , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[13]  Antonio Bicchi,et al.  On time-optimal trajectories for differential drive vehicles with field-of-view constraints , 2014, 53rd IEEE Conference on Decision and Control.

[14]  Devin J. Balkcom,et al.  Minimum Wheel-Rotation Paths for Differential-Drive Mobile Robots , 2009, Int. J. Robotics Res..

[15]  Daniel E. Koditschek,et al.  Safe Cooperative Robot Dynamics on Graphs , 2000, SIAM J. Control. Optim..

[16]  Roland Siegwart,et al.  Introduction to Autonomous Mobile Robots, Second Edition , 2011, Intelligent robotics and autonomous agents.

[17]  Philippe Souères,et al.  Optimal trajectories for nonholonomic mobile robots , 1998 .

[18]  Devin J. Balkcom,et al.  Time Optimal Trajectories for Bounded Velocity Differential Drive Vehicles , 2002, Int. J. Robotics Res..

[19]  Roland Siegwart,et al.  Introduction to Autonomous Mobile Robots , 2004 .

[20]  Kristin Y. Pettersen,et al.  Vision Restricted Path Planning and Control for Underactuated Vehicles , 2016 .

[21]  Emmanuel Trélat,et al.  Optimal Control with State Constraints and the Space Shuttle Re-entry Problem , 2003 .

[22]  Antonio Bicchi,et al.  Epsilon-Optimal Synthesis for Vehicles With Vertically Bounded Field-Of-View , 2015, IEEE Transactions on Automatic Control.

[23]  Leonidas J. Guibas,et al.  The Robot Localization Problem , 1995, SIAM J. Comput..

[24]  J. Sussmann,et al.  SHORTEST PATHS FOR THE REEDS-SHEPP CAR: A WORKED OUT EXAMPLE OF THE USE OF GEOMETRIC TECHNIQUES IN NONLINEAR OPTIMAL CONTROL. 1 , 1991 .

[25]  Antonio Bicchi,et al.  A Hybrid-Control Approach to the Parking Problem of a Wheeled Vehicle Using Limited View-Angle Visual Feedback , 2004, Int. J. Robotics Res..

[26]  Arthur E. Bryson,et al.  Applied Optimal Control , 1969 .

[27]  L. S. Pontryagin,et al.  Mathematical Theory of Optimal Processes , 1962 .

[28]  Andrew Zisserman,et al.  Multiple view geometry in computer visiond , 2001 .

[29]  Antonio Bicchi,et al.  Shortest paths for finned, winged, legged, and wheeled vehicles with side-looking sensors , 2012, Int. J. Robotics Res..

[30]  Hongwei Lou,et al.  Existence and Nonexistence Results of an Optimal Control Problem by Using Relaxed Control , 2007, SIAM J. Control. Optim..

[31]  Gregory Dudek,et al.  Localizing a robot with minimum travel , 1995, SODA '95.

[32]  Z. Shiller,et al.  Computation of Path Constrained Time Optimal Motions With Dynamic Singularities , 1992 .

[33]  Michael Kupferschmid,et al.  Performance of Several Optimization Methods on Robot Trajectory Planning Problems , 1994, SIAM J. Sci. Comput..

[34]  Huifang Wang,et al.  A Geometric Algorithm to Compute Time-Optimal Trajectories for a Bidirectional Steered Robot , 2009, IEEE Transactions on Robotics.

[35]  Arthur E. Bryson,et al.  OPTIMAL PROGRAMMING PROBLEMS WITH INEQUALITY CONSTRAINTS , 1963 .

[36]  Andrea Cristofaro,et al.  Optimal trajectories for multi robot localization , 2010, 49th IEEE Conference on Decision and Control (CDC).

[37]  L. Dubins On Curves of Minimal Length with a Constraint on Average Curvature, and with Prescribed Initial and Terminal Positions and Tangents , 1957 .

[38]  Tristan Perez,et al.  Unmanned aerial surveillance system for hazard collision avoidance in autonomous shipping , 2016, 2016 International Conference on Unmanned Aircraft Systems (ICUAS).

[39]  Nicholas R. Gans,et al.  Stable Visual Servoing Through Hybrid Switched-System Control , 2007, IEEE Transactions on Robotics.

[40]  Devin J. Balkcom,et al.  Time-optimal Trajectories for an Omni-directional Vehicle , 2006, Int. J. Robotics Res..

[41]  Antonio Bicchi,et al.  Shortest Paths for a Robot With Nonholonomic and Field-of-View Constraints , 2010, IEEE Transactions on Robotics.

[42]  P. Souéres,et al.  Shortest paths synthesis for a car-like robot , 1996, IEEE Trans. Autom. Control..

[43]  Antonio Bicchi,et al.  Shortest paths for wheeled robots with limited Field-Of-View: Introducing the vertical constraint , 2013, 52nd IEEE Conference on Decision and Control.

[44]  Sonia Martínez,et al.  Robust rendezvous for mobile autonomous agents via proximity graphs in arbitrary dimensions , 2006, IEEE Transactions on Automatic Control.

[45]  Steven M. LaValle,et al.  Nonpositive Curvature and Pareto Optimal Coordination of Robots , 2006, SIAM J. Control. Optim..