Skip to main content
SpringerLink
Log in

Integrated Trajectory Optimization

  • Reference work entry
  • First Online:
Handbook of Driver Assistance Systems

Abstract

New active driver assistance systems that work at the road and navigation level as well as automated driving face a challenging task. They have to permanently calculate the vehicle input commands (such as those for the steering, brakes, and the engine/powertrain) in order to realize a desired future vehicle movement, a driving trajectory. This trajectory has to be optimal in terms of some optimization criterion (in general a trade-off between comfort, safety, energy effort, and traveling time), needs to take the vehicular dynamics into account, and must incorporate lane boundaries or the predicted free space amid (possibly moving) obstacles. This kind of optimization can be mathematically formulated as a so-called optimal control problem. In order to limit the calculation effort, the optimal control problem is usually solved only on a limited prediction interval (starting with the current time) leading to a receding horizon optimization.

The chapter illustrates this practically proven approach in detail. Furthermore, the three general principles of dynamic optimization known from control theory and robotics are presented, namely, calculus of variations, direct optimization, and dynamic programming. Furthermore, their application to driver assistance systems and automated driving is exemplified and the high practical relevance supported by the given literature. Finally, the respective advantages and limitations of the optimization principles are discussed in detail proposing their combination for more involved system designs.

This is a preview of subscription content, log in via an institution to check access.

Access this chapter

Log in via an institution
Chapter
USD 29.95
Price excludes VAT (USA)
  • Available as PDF
  • Read on any device
  • Instant download
  • Own it forever
eBook
USD 799.99
Price excludes VAT (USA)
  • Available as EPUB and PDF
  • Read on any device
  • Instant download
  • Own it forever
Hardcover Book
USD 999.99
Price excludes VAT (USA)
  • Durable hardcover edition
  • Dispatched in 3 to 5 business days
  • Free shipping worldwide - see info

Tax calculation will be finalised at checkout

Purchases are for personal use only

Institutional subscriptions

References

  • Althoff D, Werling M, Kaempchen N, Wollherr D, Buss M (2012) Lane-based safety assessment of road scenes using inevitable collision states. In: Intelligent vehicles symposium, Madrid (Spain), pp 31–36

    Google Scholar 

  • Bellman R (1954) The theory of dynamic programming. RAND-P-550. Rand Corporation, Santa Monica

    Google Scholar 

  • Bertsekas DP (1995) Dynamic programming and optimal control. Athena Scientific, Belmont

    MATH  Google Scholar 

  • Blanchini F (1999) Set invariance in control. Automatica 35:1747–1767

    Article  MathSciNet  MATH  Google Scholar 

  • Bock H, Plitt K (1984) A multiple shooting algorithm for direct solution of optimal control problems. In: 9th IFAC world congress, Budapest (Hungary), pp 242–247

    Google Scholar 

  • Boissonnat JD, Cerezo C, Leblond J (1994) A note on shortest paths in the plane subject to a constraint on the derivative of the curvature. Report 2160, INRIA

    Google Scholar 

  • Brandt T (2008) A predictive potential field concept for shared vehicle guidance. PhD thesis, University of Paderborn

    Google Scholar 

  • Bryson AE, Ho YC (1975) Applied optimal control. Wiley, New York

    Google Scholar 

  • Carvalho A, Gao Y, Gray A, Tseng H, Borrelli F (2013) Predictive control of an autonomous ground vehicle using an iterative linearization approach. In: Conference on intelligent transportation system, IEEE, The Hague (Netherlands), pp 2335–2340

    Google Scholar 

  • Diehl M, Bock HG, Diedam H, Wieber PB (2006) Fast motions in biomechanics and robotics. Lecture notes in control and information sciences. Springer, Berlin, Heidelberg. pp 65–94

    Google Scholar 

  • Dolgov D, Thrun S, Monteberlo M, Diebel J (2010) Path planning for autonomous vehicles in unknown semi-structured environments. Int J Robot Res 29(5):485–501

    Article  Google Scholar 

  • Dubins LE (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):497–516

    Article  MathSciNet  MATH  Google Scholar 

  • Eichhorn A, Werling M, Zahn P, Schramm D (2013) Maneuver prediction at intersections using cost-to-go gradients. In: International conference on intelligent transportation systems, IEEE, The Hague (Netherlands), pp 112–117

    Google Scholar 

  • Falcone P, Borelli F, Asgari J, Tseng E, Hrovat D (2007a) Predictive active steering control for autonomous vehicle systems. IEEE Trans Control Syst Technol 15(3):566–580

    Google Scholar 

  • Falcone P, Tufo M, Borrelli F, Asgari J, Tsengz HE (2007b) A linear time varying model predictive control approach to the integrated vehicle dynamics control problem in autonomous systems. In: Conference on decision and control, IEEE, New Orleans (USA), pp 2980–2985

    Google Scholar 

  • Ferguson D, Howard TM, Likhachev M (2008a) Motion planning in urban environments: part I. In: International conference on intelligent robots and systems, IEEE/RSJ, Nice (France), pp 1063–1069

    Google Scholar 

  • Ferguson D, Howard TM, Likhachev M (2008b) Motion planning in urban environments: part II. In: International conference on intelligent robots and systems, IEEE/RSJ, Nice (France), pp 1063–1069

    Google Scholar 

  • Fraichard T (2007) A short paper about motion safety. In: International conference on robotics and automation, IEEE, Singapore, pp 1140–1145

    Google Scholar 

  • Gayko J (2012) Lane keeping support. In: Handbuch Fahrerassistenzsysteme. Vieweg + Teubner Verlag, Wiesbaden, pp 554–561

    Google Scholar 

  • Gerdts M, Karrenberg S, Müller-Bessler B, Stock G (2009) Generating locally optimal trajectories for an automatically driven car. Optim Eng 10(4):439–463

    Article  MATH  Google Scholar 

  • Graichen K (2012) A fixed-point iteration scheme for real-time model predictive control. Automatica 48(7):1300–1305

    Article  MathSciNet  MATH  Google Scholar 

  • Grüne L, Pannek J (2011) Nonlinear model predictive control: theory and algorithms. Springer, London

    Book  Google Scholar 

  • Gu T, Dolan JM (2012) On-road motion planning for autonomous vehicles. In: Intelligent robotics and applications. Springer, Berlin, pp 588–597

    Chapter  Google Scholar 

  • Gu T, Snider J, Dolan JM, Lee J (2013) Focused trajectory planning for autonomous on-road driving. In: Intelligent vehicles symposium, IEEE, Gold Coast City (Australia), pp 547–552

    Google Scholar 

  • Gutjahr B, Werling M (2014) Automatic collision avoidance during parking and maneuvering – an optimal control approach. In: Intelligent vehicles symposium, IEEE, Dearborn (USA), pp 636–641

    Google Scholar 

  • Hargraves CR, Paris SW (1987) Direct trajectory optimization using nonlinear programming and collocation. J Guid Control Dyn AAS/AIAA Astrodyn Conf 10:338–342

    Article  MATH  Google Scholar 

  • Howard TM, Kelly A (2007) Optimal rough terrain trajectory generation for wheeled mobile robots. Int J Robot Res 26(2):141–166

    Article  Google Scholar 

  • Kang K (2012) Online optimal obstacle avoidance for rotary-wing autonomous unmanned aerial vehicles. PhD-thesis, Georgia Institute of Technology

    Google Scholar 

  • Katzwinkel R, Auer R, Brosig S, Rohlfs M, Schöning V, Schroven F, Wuttke U (2012) Einparkassistenz. In: Handbuch Fahrerassistenzsysteme. Vieweg + Teubner Verlag, Wiesbaden, pp 471–477

    Google Scholar 

  • Kelly A, Nagy B (2003) Reactive nonholonomic trajectory generation via parametric optimal control. Int J Robot Res 22(7–8):583–601

    Article  Google Scholar 

  • Koren Y, Borenstein J (1991) Potential field methods and their inherent limitations for mobile robot navigation. In: International conference on robotics and automation, IEEE, Sacramento (USA), pp 1398–1404

    Google Scholar 

  • Krogh BH (1984) A generalized potential field approach to obstacle avoidance control. In: International robotics research conference, Bethlehem

    Google Scholar 

  • Latombe JC (1990) Robot motion planning. Springer Science+Business Media New York

    Google Scholar 

  • LaValle SM (2006) Planning algorithms. Cambridge University Press, Cambridge

    Book  MATH  Google Scholar 

  • Lawitzky A, Nicklas A, Wollherr D, Buss M (2014) Determining states of inevitable collision using reachability analysis. In: International conference on intelligent robots and systems, IEEE/RSJ, Chicago (USA), pp 4142–4147

    Google Scholar 

  • Lewis F, Syrmos V (1995) Optimal control. Wiley, New York

    Google Scholar 

  • Likhachev M, Ferguson D (2009) Planning long dynamically feasible maneuvers for autonomous vehicles. Int J Robot Res 28(8):933–945

    Article  Google Scholar 

  • McNaughton M (2011) Parallel algorithms for real-time motion planning. PhD thesis, Carnegie Mellon University

    Google Scholar 

  • Montemerlo M et al (2008) Junior: the Stanford entry in the Urban Challenge. J Field Robot 25(9):569–597

    Article  Google Scholar 

  • Nocedal J, Wright SJ (2006) Numerical optimization. Springer Science+Business Media New York

    Google Scholar 

  • Park JM, Kim DW, Yoon YS, Kim HJ, Yi KS (2009) Obstacle avoidance of autonomous vehicles based on model predictive control. Proc Inst Mech Eng D J Automob Eng 223(12):1499–1516

    Article  Google Scholar 

  • Pivtoraiko M, Knepper RA, Kelly A (2009) Differentially constrained mobile robot motion planning in state lattices. J Field Robot 26(3):308–333

    Article  Google Scholar 

  • Rawlings JB (2000) Tutorial overview of model predictive control. IEEE Control Syst 20(3):38–52

    Article  MathSciNet  Google Scholar 

  • Reeds JA, Shepp LA (1990) Optimal paths for a car that goes both forwards and backwards. Pac J Math 145(2):367–393

    Article  MathSciNet  Google Scholar 

  • Rouchon P, Fliess M, Levine J, Martin P (1993) Flatness, motion planning and trailer systems. In: Conference on decision and control, IEEE, San Antonio (USA), pp 2700–2705

    Google Scholar 

  • Werling M, Liccardo D (2012) Automatic collision avoidance using model-predictive online optimization. In: Conference on decision and control, IEEE, Maui (USA), pp 6309–6314

    Google Scholar 

  • Werling M, Kammel S, Ziegler J, Gröll L (2012) Optimal trajectories for time-critical street scenarios using discretized terminal manifolds. Int J Robot Res 31(3):346–359

    Article  Google Scholar 

  • Yoon Y, Shin J, Kim HJ, Park Y, Sastry S (2009) Model-predictive active steering and obstacle avoidance for autonomous ground vehicles. Control Eng Pract 17(7):741–750

    Article  Google Scholar 

  • Ziegler J, Stiller C (2009) Spatiotemporal state lattices for fast trajectory planning in dynamic on-road driving scenarios. In: International conference on intelligent robots and systems, IEEE/RSJ, St. Louis (USA), pp 1879–1884

    Google Scholar 

  • Ziegler J, Werling M, Schröder J (2008) Navigating car-like robots in unstructured environments using an obstacle sensitive cost function. In: Intelligent vehicles symposium, IEEE, Eindhoven (Netherlands), pp 787–791

    Google Scholar 

  • Ziegler J, Bender P, Dang T, Stiller C (2014) Trajectory planning for bertha – a local, continuous method. In: Intelligent vehicles symposium proceedings, IEEE, Dearborn (USA), pp 450–457

    Google Scholar 

Download references

Author information

Authors and Affiliations

  1. BMW Group, München, Germany

    Moritz Werling

Authors
  1. Moritz Werling
    View author publications

    You can also search for this author in PubMed Google Scholar

Corresponding author

Correspondence to Moritz Werling .

Editor information

Editors and Affiliations

  1. Institute of Automotive Engineering, Technische Universität Darmstadt, Darmstadt, Germany

    Hermann Winner

  2. Continental Engineering Services GmbH, Frankfurt am Main, Germany

    Stephan Hakuli

  3. Continental AG, Frankfurt am Main, Germany

    Felix Lotz

  4. Institute of Automotive Engineering, Technische Universität Darmstadt, Darmstadt, Germany

    Christina Singer

Rights and permissions

Reprints and permissions

Copyright information

© 2016 Springer International Publishing Switzerland

About this entry

Cite this entry

Werling, M. (2016). Integrated Trajectory Optimization. In: Winner, H., Hakuli, S., Lotz, F., Singer, C. (eds) Handbook of Driver Assistance Systems. Springer, Cham. https://doi.org/10.1007/978-3-319-12352-3_64

Download citation

Publish with us

Policies and ethics

Search

Navigation