Generation of Smooth Reference Trajectories for Unmanned Wheeled Platforms Considering Automatic Constraints On Velocity, Acceleration and Jerk

The problem of generating smooth and achievable trajectories for the center of mass of unmanned wheeled platforms approximating a reference sequence of waypoints considering time is considered. A typical solution consists in spline interpolation of separate route sections with their subsequent stitching. At the same time, the problem of satisfying constraints on robot motion features such as velocity, acceleration, and jerk requires additional algorithmization. In contrast to labor-intensive analytical methods, this paper proposes a fundamentally new approach, simple in computational implementation, which provides dynamic smoothing of primitive trajectories. The principle of organization and method of designing an autonomous dynamic model (tracking differentiator) whose output variables, while tracking a primitive non-smooth trajectory, generate smooth curves whose derivatives do not exceed the design constraints of a particular robot and are achievable reference trajectories for it. Block control principle and smooth and bounded S-shaped sigmoidal local links are used to design the differentiator. The paper presents a procedure for setting up a three-block tracking differentiator, whose variables generate a smooth reference trajectory, as well as its first and second derivatives, in a signal pocoordinate form. It is shown that the developed procedure extends to tracking differentiators of any required order without limitation of generality. In particular, the structure and setting of a single-block tracking differentiator for obtaining express results at the stage of robot or polygon motion planning is specified. Numerical simulation results confirming the efficiency of the designed algorithms are presented.

1. Kochetkov S. A., Utkin V. A. Method of decomposition in mobile robot control, Autom. Remote Control, 2011, vol. 72, no. 10, pp. 2084—2099.

2. Pesterev A. V., Rapoport L. B., Tkachev S. B. Canonical representation of a nonstationary path following problem, J. Comput. Syst. Sci. Int., 2015, vol. 54, pp. 656—670.

3. Tyulenev I. D., Filimonov N. B. Algorithmization of Automatic Parking Control of Self-Driving Car, Mekhatronika, Avtomatizatsiya, Upravlenie, 2023, vol. 24, no 12, pp. 634—642 (in Russian).

4. Tzafestas S. G. Mobile robot control and navigation: A global overview, J. Intell. Robot. Syst, 2018, vol. 91, pp. 35—58.

5. Bautista G. D., Perez J., Milanés V. A review of motion planning techniques for automated vehicles, IEEE Trans. Intell. Transpor. Syst., 2015, vol. 17, no. 4, pp. 1—11.

6. Chekushkin V. V., Zhiganov S. N., Bykov A. A., Miheev K. V. The Reproduction of the Trajectories of Moving Objects in the Systems of Control of Air Space, Mekhatronika, Avtomatizatsiya, Upravlenie, 2018, vol. 19, no. 2, pp. 126—133 (in Russian).

7. Rosu H. C., Mancas S. C., Hsieh C.-C. Generalized Cornu-type spirals and their Darboux parametric deformations, Physics Letters A, 2019, vol. 383, no. 23, pp. 2692—2697.

8. Kostjukov V. A., Medvedev M. Y., Pshikhopov V. Kh. Algorithms for Planning Smoothed Individual Trajectories of Ground Robots, Mekhatronika, Avtomatizatsiya, Upravlenie, 2022, vol. 23, no 11, pp. 585—595 (in Russian).

9. Mercy T., Van Parys R., Pipeleers G. Spline-Based Motion Planning for Autonomous Guided Vehicles in a Dynamic Environment, IEEE Trans. Control Syst. Technol., 2017, vol. 26, no. 6, pp. 2182—2189.

10. Sun Y., Yang J., Zhao D., Shu Y., Zhang Z., Wang S. A Global Trajectory Planning Framework Based on Minimizing the Risk Index, Actuators, 2023, vol. 12, no. 7, p. 270.

11. Han J. Mobile robot path planning with surrounding point set and path improvement, Appl. Soft Comput., 2017, vol. 57, pp. 35—47.

12. Busurin V. I., Kazaryan A. V., Shtek S. G., Zheglov M. A., Vasetskiy S. O., Kyi P. L. Frame Micro-Optoelectromechanical Angular Velocity Transducer with Optical Readout Units Based on the Optical Tunneling Effect, Measurement Techniques, 2022, vol. 65, no. 5, pp. 360—365.

13. Gao Y., Tian D., Wang Y. Fuzzy Self-Tuning Tracking Differentiator for Motion Measurement Sensors and Application in Wide-Bandwidth High-Accuracy Servo Control, Sensors, 2020, vol. 20, no. 3, p. 948.

14. Kochetkov S. A., Krasnova S. A., Antipov A. S. Cascade Synthesis of Electromechanical Tracking Systems with Respect to Restrictions on State Variables, IFAC PapersOnLine, 2017, vol. 50, no. 1, pp. 1042—10147.

15. Antipov A. S., Krasnova S. A., Utkin V. A. Synthesis of Invariant Nonlinear Single-Channel Sigmoid Feedback Tracking Systems Ensuring Given Tracking Accuracy, Autom. Remote Control, 2022, vol. 83, no 1, pp. 32—53.

16. Kokunko Y. G., Krasnova S. A., Utkin V. A. Cascade Synthesis of Differentiators with Piecewise Linear Correction Signals, Autom. Remote Control, vol. 82, no 7, pp. 1144—1168.

17. Xiang D., Lin H., Ouyang J., Huang D. Combined improved A* and greedy algorithm for path planning of multiobjective mobile robot, Sci. Rep., 2022, vol. 12, no. 1, p. 13273.

18. Belinskaya Yu. S. Application of the covering method for trajectories design for car-like robot, In Proc. 14th Int. Conf. "Management of large-scale system development” (MLSD), 2021.

19. Fliess M., Levine J. L., Martin Ph., Rouchon P. Flatness and defect of non-linear systems: introductory theory and examples, International Journal of Control, 1995, vol. 61, no 6, pp. 1327—1361.

20. Antipov A. S., Kokunko Yu. G., Krasnova S. A., Utkin V. A. Dynamic Smoothing, Filtering and Differentiation of Signals Defining the Path of the UAV, Sensors, 2022, vol. 22, p. 9472.