Abstract

This paper studies the time optimal paths of a mobile robot navigating in a planar environment containing an obstacle. The paper considers a point-mass robot that moves with bounded acceleration and limited turn-rate controls in the presence of an obstacle. The optimal control problem yields 12 path primitives that form the time optimal paths of the point-mass robot. The problem is then extended to a disc-robot that moves in the presence of an obstacle with turn in-place capability. The optimality conditions yield 12 modified path primitives that form the time optimal paths of the disc-robot. All path primitives are analytically characterized and examples demonstrate how they form time optimal trajectories in the presence of several obstacle types.

References

1.
Lynch
,
K. M.
, and
Park
,
F. C.
,
2017
,
Modern Robotics: Mechanics, Planning, and Control
,
Cambridge University Press
,
Cambridge
.
2.
Samson
,
C.
,
Morin
,
P.
, and
Lenain
,
R.
,
2016
, “Modeling and Control of Wheeled Mobile Robots,”
Handbook of Robotics
,
Siciliano
and
Khatib
, eds.,
Springer Verlag
,
New York
, pp.
1235
1265
.
3.
de Wit
,
C. C.
,
Siciliano
,
B.
, and
Bastin
,
G.
,
2012
,
Theory of Robot Control
,
Springer-Verlag
,
New York
.
4.
Rieck
,
M.
,
Bittner
,
M.
,
Grueter
,
B.
, and
Diepolder
,
J.
,
2020
, “
FALCON.m: User Guide
,”
Inst. of Flight System Dynamics, Technische Universitat Munchen
, http://www.fsd.mw.tum.de/software/falcon-m
5.
Patterson
,
M. A.
, and
Rao
,
A. V.
,
2014
, “
GPOPS-II, a MATLAB Software for Solving Multiple-Phase Optimal Control Problems Using Hp-Adaptive Gaussian Quadrature Collocation Methods and Sparse Nonlinear Programming
,”
ACM Trans. Math. Softw.
,
41
(
1
), pp.
1
37
. 10.1145/2558904
6.
Dubins
,
L. E.
,
1957
, “
On Curves of Minimal Length With a Constraint on Average Curvature, and With Prescribed Initial and Terminal Positions and Tangents
,”
Am. J. Math.
,
79
(
3
), pp.
497
516
. 10.2307/2372560
7.
Reeds
,
J. A.
, and
Shepp
,
L. A.
,
1990
, “
Optimal Paths for a Car That Goes Both Forwards and Backwards
,”
Pacific J. Math
,
145
(
2
), pp.
367
393
. 10.2140/pjm.1990.145.367
8.
Boissonnat
,
J.-D.
,
Cerezo
,
A.
, and
Leblond
,
K.
,
1992
, “
Shortest Paths of Bounded Curvature in the Plane
,”
IEEE Int. Conf. Robot. Autom.
, pp.
2315
2320
.
9.
Sussmann
,
H. J.
, and
Tang
,
G.
,
1991
, “
Shortest Paths for the Reeds-Shepp Car: A Worked Out Example of the Use of Geometric Techniques in Non-linear Optimal Control
,”
Rutgers University
,
New Brunswick, NJ
,
Technical Report SYCON-91-10
.
10.
Balkcom
,
D. J.
, and
Mason
,
M. T.
,
2002
, “
Time Optimal Trajectories for Bounded Velocity Differential Drive Vehicles
,”
Int. J. Rob. Res.
,
21
(
3
), pp.
199
217
. 10.1177/027836402320556403
11.
Takei
,
R.
,
Tsai
,
R.
,
Shen
,
H.
, and
Landa
,
Y.
,
2010
, “
A Practical Path-Planning Algorithm for a Vehicle With a Constrained Turning Radius: A Hamilton-Jacobi Approach
,”
J. Sci. Comput
.
12.
Donald
,
B.
,
Xavier
,
P.
,
Canny
,
J.
, and
Reif
,
J.
,
1993
, “
Kinodynamic Motion Planning
,”
J. ACM
,
40
(
5
), pp.
1048
1066
. 10.1145/174147.174150
13.
Laumond
,
J.-P.
,
Jacobs
,
P. E.
,
Taix
,
M.
, and
Murray
,
R. M.
,
1994
, “
A Motion Planner for Nonholonomic Mobile Robots
,”
IEEE Trans. Rob. Autom.
,
10
(
5
), pp.
577
593
. 10.1109/70.326564
14.
Karaman
,
S.
, and
Frazzoli
,
E.
,
2010
, “
Optimal Kinodynamic Motion Planning Using Incremental Sampling-Based Methods
,”
IEEE 49th Conference on Decision and Control
, pp.
7681
7687
.
15.
Manor
,
G.
,
Ben-Asher
,
J. Z.
, and
Rimon
,
E.
,
2018
, “
Time Optimal Trajectories for a Mobile Robot Under Explicit Acceleration Constraints
,”
IEEE Trans. Aerosp. Electron. Syst.
,
54
(
5
), pp.
2220
2232
. 10.1109/TAES.2018.2811158
16.
Pontryagin
,
L. S.
,
Boltyanskii
,
V. G.
,
Gamkrelidze
,
R. V.
, and
Mishchenko
,
E. F.
,
1962
,
The Mathematical Theory of Optimal Processes
,
Interscience Publishers John Wiley & Sons
,
New York
.
17.
Kelley
,
H. J.
,
Kopp
,
R. E.
, and
Moyer
,
H. G.
,
1967
, “Singular Extremals,”
Topics in Optimization
,
G.
Leitmann
, ed.,
Academic Press
,
New York
, pp.
63
101
.
18.
Ben-Asher
,
J. Z.
,
Wetzler
,
M.
,
Rimon
,
E. D.
, and
Diepolder
,
J.
,
2019
, “
Optimal Trajectories for a Mobile Robot With Bounded Accelerations in the Presence of a Wall Or a Bounded Obstacle
,”
MED Conference on Control and Automation
.
19.
Ben-Asher
,
J. Z.
,
2010
,
Optimal Control Theory With Aerospace Applications
,
American Institute of Aeronautics and Astronautics (AIAA)
,
Reston, VA
.
20.
Chang
,
S. S. L.
,
1962
, “
Optimal Control in Bounded Phase Space
,”
Automatica
,
1
, pp.
55
67
. 10.1016/0005-1098(63)90006-2
21.
Hartl
,
R. F.
,
Sethi
,
S. P.
, and
Vickson
,
R. G.
,
1995
, “
A Survey of the Maximum Principles for Optimal Control Problems With State Constraints
,”
SIAM Rev.
,
37
(
2
), pp.
181
218
. 10.1137/1037043
22.
Betts
,
J. T.
,
2010
,
Practical Methods for Optimal Control Using Nonlinear Programming
,
SIAM Society for Industrial and Applied Mathematics
,
Philadelphia, PA
.
23.
Rimon
,
E.
, and
Manor
,
G.
,
2017
, “
The Speed Graph Method: Time Optimal Navigation Among Obstacles Subject to Uniform Braking Safety Constraints
,”
Autom. Rob.
,
41
(
2
), pp.
385
400
. 10.1007/s10514-015-9538-9
You do not currently have access to this content.