Skip to main content
Log in

Numerical Method with High Real-time Property Based on Shortest Path Algorithm for Optimal Control

  • Regular Papers
  • Control Theory and Applications
  • Published:
International Journal of Control, Automation and Systems Aims and scope Submit manuscript

Abstract

A numerical method consisting of an off-line part and an on-line part for optimal control problems is proposed in this paper. In the off-line part, the state space is discretized into a Cartesian grid structure and then define a graph over all grid points by connecting two points if the Euclidean norm between them is closer than a positive number called adjacent radius, the minimum cost between them is estimated using difference method and stored in a matrix. After that the matrix is updated by a shortest path algorithm and a matrix holding the information of the shortest paths between any two grid points is generated. In the on-line part, the optimal control vector at each time step can be generated by reading data from the matrix according to the current state and target state and doing some simple calculations. Since there is no need to do a lot of calculation in the on-line part, this method can satisfy the real-time requirements in some engineering control problems. We prove that the solution of the proposed method converge to the analytical solution when the adjacent radius and the grid size tend to zero and the grid size tend is a higher order infinitesimal of the adjacent radius. At the end of this paper, some numerical examples are taken to illustrate the effectiveness of the proposed method.

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

Access this article

Price excludes VAT (USA)
Tax calculation will be finalised during checkout.

Instant access to the full article PDF.

Similar content being viewed by others

References

  1. H. J. Pesch and M. Plail, “The maximum principle of optimal control: A history of ingenious ideas and missed opportunities,” Control and Cybernetics, vol. 38, pp. 973–995, 2009.

    MathSciNet  MATH  Google Scholar 

  2. M. Athans and P. L. Falb, Optimal Control. An Introduction to the Theory and Its Applications, McGraw-Hill Book Co., New York-Toronto, Ont.-London, 1966.

    MATH  Google Scholar 

  3. J. Snyman, Practical Mathematical Optimization. An Introduction to Basic Optimization Theory and Classical and New Gradient-Based Algorithms, Springer, Boston, MA, 2005.

    MATH  Google Scholar 

  4. J. Snyman and D. Wilke, Practical Mathematical Optimization: Basic Optimization Theory and Gradient-Based Algorithms, Springer Optimization and Its Applications 133, 2018.

  5. C. Lánczos, The Variational Principles of Mechanics, 4th ed., ser. Mathematical Expositions, No. 4. University of Toronto Press, Toronto, Ont., 1970.

    MATH  Google Scholar 

  6. R. Andreani, J. Martinez, and M. Schuverdt, “On the relation between constant positive linear dependence condition and quasinormality constraint qualification,” Journal of Optimization Theory and Applications, vol. 125, pp. 473–483, 2005.

    Article  MathSciNet  Google Scholar 

  7. Y. M. Agamawi, W. W. Hager, and A. V. Rao, “Mesh refinement method for solving bang-bang optimal control problems using direct collocation,” Proc. of AIAA Scitech 2020 Forum, Orlando, FL, January 2020.

  8. R. Hannemann-Tamás and W. Marquardt, “How to verify optimal controls computed by direct shooting methods? — A tutorial,” Journal of Process Control, vol. 22, no. 2, pp. 494–507, 2012.

    Article  Google Scholar 

  9. J. T. Betts, “Survey of numerical methods for trajectory optimization,” Journal of Guidance, Control, and Dynamics, vol. 21, no. 2, pp. 193–207, 1998.

    Article  Google Scholar 

  10. M. Giftthaler, M. Neunert, M. Stäuble, J. Buchli, and M. Diehl, “A family of iterative gauss-newton shooting methods for nonlinear optimal control,” Proc. of IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), Madrid, Spain, pp. 1–9, October 2018.

  11. S. Munzir, V. Halfiani, and M. Ramli, “An optimal control solution using multiple shooting method,” Bulletin of Mathematics, vol. 4, no. 2, pp. 143–160, 2012.

    Google Scholar 

  12. C. Kirches, The Direct Multiple Shooting Method for Optimal Control, pp. 13–29, 2011.

  13. H. Bock and K. Plitt, “A multiple shooting algorithm for direct solution of optimal control problems,” IFAC Proceedings Volumes, vol. 17, no. 2, pp. 1603–1608, 1984.

    Article  Google Scholar 

  14. C. Hargraves and S. Paris, “Direct trajectory optimization using nonlinear programming and collocation,” Journal of Guidance, Control, and Dynamics, vol. 10, no. 4, pp. 338–342, 1987.

    Article  Google Scholar 

  15. J. T. Betts, Practical Methods for Optimal Control Using Nonlinear Programming, vol. 3, ser. Advances in Design and Control. Society for Industrial and Applied Mathematics (SIAM), Philadelphia, PA, 2001.

    MATH  Google Scholar 

  16. D. Gottlieb, M. Hussaini, and S. Orszag, “Theory and applications of spectral methods,” in Spectral Methods for PDE’s, SIAM, Philadelphia, PA, pp. 1–54, January 1984.

    Google Scholar 

  17. I. M. Ross and F. Fahroo, “A direct method for solving non-smooth optimal control problems,” IFAC Proceedings Volumes, vol. 35, no. 1, pp. 479–484, 2002.

    Article  Google Scholar 

  18. D. A. Benson, G. T. Huntington, T. P. Thorvaldsen, and A. V. Rao, “Direct trajectory optimization and costate estimation via an orthogonal collocation method,” Journal of Guidance, Control, and Dynamics, vol. 29, no. 6, pp. 1435–1440, 2006.

    Article  Google Scholar 

  19. Y. Gao and C. Kluever, “Low-thrust interplanetary orbit transfers using hybrid trajectory optimization method with multiple shooting,” Proc. of AIAA/AAS Astrodynamics Specialist Conference and Exhibit, Providence, Rhode Island, August 2004.

  20. G. L. Brauer, D. E. Cornick, and R. Stevenson, “Capabilities and applications of the program to optimize simulated trajectories (POST). Program summary document,” NASA, Tech, Rep., February 1977.

  21. A. Rao, D. Benso, C. Darby, C. Francolin, M. Patterson, I. Sanders, and G. Huntington, “Algorithm 902: Gpops, a matlab software for solving multiple-phase optimal control problems,” ACM Transactions on Mathematical Software, vol. 37, 2010.

  22. R. K. Ahuja, K. Mehlhorn, J. B. Orlin, and R. E. Tarjan, “Faster algorithms for the shortest path problem,” Journal of the ACM, vol. 37, no. 2, pp. 213–223, 1990.

    Article  MathSciNet  Google Scholar 

  23. B. V. Cherkassky, A. V. Goldberg, and T. Radzik, “Shortest paths algorithms: Theory and experimental evaluation,” Mathematical Programming, vol. 73, no. 2, pp. 129–174, May 1966.

    Article  MathSciNet  Google Scholar 

  24. R. W. Floyd, “Algorithm 97: Shortest path,” Commun. ACM, vol. 5, p. 345, 1962.

    Article  Google Scholar 

Download references

Author information

Authors and Affiliations

Authors

Corresponding author

Correspondence to Xiaohui Wei.

Additional information

Publisher’s Note Springer Nature remains neutral with regard to jurisdictional claims in published maps and institutional affiliations.

The authors gratefully acknowledge support from National Defense Outstanding Youth Science Foundation (Grant No. 2018-JCJQ-ZQ-053), A Project Funded by the Priority Academic Program Development of Jiangsu Higher Education Institutions and Central University Basic Scientific Research Operating Expenses Special Fund Project Support (Grant No. NF2018001). Also, the authors would like to thank the anonymous reviewers, associate editor, and editor for their valuable and constructive comments and suggestions. In the on-line part, the optimal control vector can be generated by reading data from the path matrix and doing some simple calculations.

Wei Liao was born in 1991. He received his bachelor degree in flight vehicle design and engineering from Nanchang Hangkong University, Nanchang, China, in 2012. And received his master degree in flight vehicle design from Nanjing University of Aeronautics and Astronautics, Nanjing, China, in 2016. He is currently working towards his doctoral degree in flight vehicle design at Nanjing University of Aeronautics and Astronautics. His research interests include optimal control, reachability analysis and artificial intelligence.

Xiaohui Wei was born in 1978. He received his bachelor degree and doctoral degree in flight vehicle design from Nanjing University of Aeronautics and Astronautics, Nanjing, China, in 2000 and 2006, respectively. He is now a professor at College of Aerospace Engineering, Nanjing University of Aeronautics and Astronautics. His research interests include nonlinear dynamics and engineering reliability.

Jizhou Lai was born in 1977. He received his bachelor degree and doctoral degree in navigation, guidance and control from Nanjing University of Aeronautics and Astronautics, Nanjing, China, in 1999 and 2005, respectively. He is now a professor at College of Automation Engineering, Nanjing University of Aeronautics and Astronautics. His research interests include navigation guidance and control and artificial intelligence.

Hao Sun was born in 1996. He received his bachelor degree in flight vehicle design and engineering from Nanjing University of Aeronautics and Astronautics, Nanjing, China, in 2019. He is currently working towards his master degree in flight vehicle design at Nanjing University of Aeronautics and Astronautics. His research interests include adaptive and nonlinear control.

Rights and permissions

Reprints and permissions

About this article

Check for updates. Verify currency and authenticity via CrossMark

Cite this article

Liao, W., Wei, X., Lai, J. et al. Numerical Method with High Real-time Property Based on Shortest Path Algorithm for Optimal Control. Int. J. Control Autom. Syst. 19, 2038–2046 (2021). https://doi.org/10.1007/s12555-020-0196-0

Download citation

  • Received:

  • Revised:

  • Accepted:

  • Published:

  • Issue Date:

  • DOI: https://doi.org/10.1007/s12555-020-0196-0

Keywords

Navigation