journal article·2022-07-03Open access

Time-Optimal Trajectory Planning of Six-Axis Manipulators Based on the Improved Direct Collocation Method with FMU

Ziyao Xiong, Jianwan Ding, Liping Chen

Applied Sciences· Volume 12· Issue 13

Abstract

The trajectory planning method with dynamics is the key to improving the motion performance of manipulators. The optimal control method (OCM) is a key technology to solve optimal problems with dynamics. There are direct and indirect methods in OCM; indirect methods are difficult to apply to engineering applications, and so direct methods are widely applied instead. The direct collocation method (DCM) is a technology in OCM to transform an optimal control problem (OCP) to a nonlinear problem (NLP), so that plenty of solvers can be used directly. However, the general DCM, for which it has been found that the explicit form of the right-hand-side (RHS) functions of state equations of the complex system in the OCP is hard to derive, is limited to solving the OCP of three-axis manipulators. This paper proposes an improved DCM to solve the OCP of six-axis manipulators, which can find the solution of the time-optimal trajectory for the motion of six-axis manipulators based on the improved DCM. The proposed method derives the RHS equations implicitly by introducing a Functional Mock-up Unit (FMU), which simplifies the representation of the RHS equations as a black-box model, so that the DCM can be applied to the OCP of six-axis manipulators. A simulation case of a three-axis manipulator accomplished in a related study works as a reference compared with our improved method to verify the solution consistence between the DCM using the explicit RHS equations or using the implicit RHS equations, and the loss of computational efficiency is acceptable. In the meantime, a simulation solution and an experiment of six-axis manipulators, which is a novel advancement, are presented to validate the proposed method.
Source: crossref · Quality: baseline

Research context

OpenAlex topics: Robotic Mechanisms and Dynamics · Robotic Path Planning Algorithms · Adaptive Control of Nonlinear Systems

SciVX discovery tags are terminology-based. OpenAlex topics are source-provided classifications.

Affiliations

School of Mechanical Science& Engineering, Huazhong University of Science and Technology, Wuhan 430070, China

Funding

the National Key R&D Program of China

References (38)

Show source-provided references
1. A dynamic programming approach to trajectory planning of robotic manipulators10.1109/TAC.1986.1104317 ↗
2. Gasparetto, A., Boscariol, P., Lanzutti, A., and Vidoni, R. (2015). Path Planning and Trajectory Planning Algorithms: A General Overview. Motion and Operation Planning of Robotic Systems, Springer.10.1007/978-3-319-14705-5_1 ↗
3. Shi, B., and Xu, J. (2020, January 27–29). Time-Optimal Trajectory Planning of Industrial Robot based on Improved Particle Swarm Optimization Algorithm. Proceedings of the 2020 39th Chinese Control Conference (CCC), Shenyang, China.10.23919/CCC50068.2020.9188907 ↗
4. Li, G., and Wang, Y. (2019, January 4–7). Industrial Robot Optimal Time Trajectory Planning Based on Genetic Algorithm. Proceedings of the 2019 IEEE International Conference on Mechatronics and Automation (ICMA), Tianjin, China.10.1109/ICMA.2019.8816319 ↗
5. Smooth point-to-point trajectory planning for industrial robots with kinematical constraints based on high-order polynomial curve
6. Yu, H., Meng, Q., and Zhang, J. (2018, January 9–11). Time-optimal trajectory planning of robot based on improved adaptive genetic algorithm. Proceedings of the 2018 Chinese Control And Decision Conference (CCDC), Shenyang, China.10.1109/CCDC.2018.8408254 ↗
7. Shi, B., and Zeng, H. (2021, January 26–28). Time-Optimal Trajectory Planning for Industrial Robot based on Improved Hybrid-PSO. Proceedings of the 2021 40th Chinese Control Conference (CCC), Shanghai, China.10.23919/CCC52363.2021.9549441 ↗
8. A Bisection Algorithm for Time-Optimal Trajectory Planning Along Fully Specified Paths10.1109/TRO.2020.3010632 ↗
9. Time-Optimal Control of Robotic Manipulators Along Specified Paths10.1177/027836498500400301 ↗
10. Time-optimal and Smooth Trajectory Planning for Robot Manipulators
11. Efficient Numerical Optimal Control for Highly Oscillatory Systems10.1109/LCSYS.2022.3175412 ↗
12. Fully Discrete Interpolation Coefficients Mixed Finite Element Methods for Semi-Linear Parabolic Optimal Control Problem
13. Time-Optimal Control of a Multidimensional Integrator Chain With Applications10.1109/LCSYS.2022.3154351 ↗
14. Toward Data-Driven Optimal Control: A Systematic Review of the Landscape10.1109/ACCESS.2022.3160709 ↗
15. Data-Driven Adaptive Dynamic Programming for Optimal Control of Continuous-Time Multicontroller Systems With Unknown Dynamics10.1109/ACCESS.2022.3168032 ↗
16. Data-Driven Optimal Control of Bilinear Systems10.1109/LCSYS.2022.3164983 ↗
17. Ant Colony Optimization Tuned Closed-Loop Optimal Control Intended for Vehicle Active Suspension System10.1109/ACCESS.2022.3164522 ↗
18. Feed-forward control of elastic-joint industrial robot based on hybrid inverse dynamic model
19. Schappler, M., Vorndamme, J., Todtheide, A., Conner, D.C., von Stryk, O., and Haddadin, S. (2015, January 3–5). Modeling, Identification and Joint Impedance Control of the Atlas Arms. Proceedings of the 2015 IEEE-RAS 15th International Conference on Humanoid Robots, Seoul, Korea.10.1109/HUMANOIDS.2015.7363499 ↗
20. Model Predictive Heuristic Control: Applications to Industrial Processes10.1016/0005-1098(78)90001-8 ↗
21. Model Predictive Control: Theory and Practice–A Survey10.1016/0005-1098(89)90002-2 ↗
22. Dynamic Matrix Control Algorithm Implementation on ARM Cortex-R5 MCU: Performance Analysis10.1016/j.ifacol.2018.07.175 ↗
23. Fault Estimation and Fault Tolerant Control Strategies Applied to VTOL Aerial Vehicles With Soft and Aggressive Actuator Faults10.1109/ACCESS.2019.2963693 ↗
24. Decentralized robust tube-based model predictive control: Application to a four-tank system
25. The near-minimum-time control of open-loop articulated kinematic chains10.1115/1.3426492 ↗
26. DFVLR Models 1 and 2 of the Manutec R3 Robot
27. Bulirsch, R., and Kraft, D. (1994). Optimal Control of the Industrial Robot Manutec r3. Computational Optimal Control, Birkhäuser Verlag.10.1007/978-3-0348-8497-6 ↗
28. Becerra, V.M. (2010, January 8–10). Solving complex optimal control problems at no cost with PSOPT. Proceedings of the 2010 IEEE International Symposium on Computer-Aided Control System Design, Yokohama, Japan.10.1109/CACSD.2010.5612676 ↗
29. An introduction to Trajectory Optimization: How to do your own Direct Collocation10.1137/16M1062569 ↗
30. A Very Efficient Algorithm for the Simulation of Robots and Similar Multibody Systems without Inversion of the Mass Matrix10.1016/S1474-6670(17)59460-4 ↗
31. Widl, E., Müller, W., Elsheikh, A., Hörtenhuber, M., and Palensky, P. (2013, January 20). The FMI++ library: A high-level utility package for FMI for model exchange. Proceedings of the 2013 Workshop on Modeling and Simulation of Cyber-Physical Energy Systems (MSCPES), Berkeley, CA, USA.10.1109/MSCPES.2013.6623316 ↗
32. Theory and application of Legendre pseudo-spectral method for solving optimal control problem
33. Fahroo, F., and Ross, I.M. (2008, January 20–23). Advances in Pseudospectral Methods for Optimal Control. Proceedings of the AIAA Guidance, Navigation and Control Conference, Honolulu, HI, USA.10.2514/6.2008-7309 ↗
34. Fahroo, F., and Ross, I.M. (2005, January 5–9). Pseudospectral Methods for Infinite-Horizon Nonlinear Optimal Control Problems. Proceedings of the AIAA Guidance, Navigation, and Control Conference, San Francisco, CA, USA.10.2514/6.2005-6076 ↗
35. Spectral Algorithm for Pseudospectral Methods in Optimal Control10.2514/1.32908 ↗
36. Modelica—An International Effort to Design the Next Generation Modeling Language10.1016/S1474-6670(17)43628-7 ↗
37. Craig, J.J. (1989). Manipulator Dynamics. Introduction to Robotics: Mechanics and Control, Horton, M.J., Ed., Addison-Wesley Longman.
38. Numerical Solution of Optimal Control Problems by Direct Collocation