A Dynamic Programming Framework for Optimal Planning of Redundant Robots Along Prescribed Paths With Kineto-Dynamic Constraints

Enrico Ferrentino,Heitor J. Savino,Antonio Franchi,Pasquale Chiacchio

DOI: https://doi.org/10.1109/TASE.2023.3330371

2023-12-12

Abstract:Offline optimal planning of trajectories for redundant robots along prescribed task space paths is usually broken down into two consecutive processes: first, the task space path is inverted to obtain a joint space path, then, the latter is parametrized with a time law. If the two processes are separated, they cannot optimize the same objective function, ultimately providing sub-optimal results. In this paper, a unified approach is presented where dynamic programming is the underlying optimization technique. Its flexibility allows accommodating arbitrary constraints and objective functions, thus providing a generic framework for optimal planning of real systems. To demonstrate its applicability to a real world scenario, the framework is instantiated for time-optimality on Franka Emika's Panda robot. The well-known issues associated with the execution of non-smooth trajectories on a real controller are partially addressed at planning level, through the enforcement of constraints, and partially through post-processing of the optimal solution. The experiments show that the proposed framework is able to effectively exploit kinematic redundancy to optimize the performance index defined at planning level and generate feasible trajectories that can be executed on real hardware with satisfactory results.

Robotics,Systems and Control,Optimization and Control

What problem does this paper attempt to address?

The paper aims to address the problem of offline optimal trajectory planning for redundant robots along a predetermined path. Specifically, the paper proposes a unified approach that combines the processes of inverse kinematics (IK) solving and time parameterization to optimize given performance metrics (such as execution time). Traditional methods treat these two processes separately, resulting in the inability to optimize the same objective function, thereby producing suboptimal results. The method proposed in this paper is based on dynamic programming techniques, offering high flexibility to accommodate any constraints and objective functions, thus providing a general optimal planning framework for practical systems.

To demonstrate its application in real-world scenarios, the framework is applied to the Franka Emika Panda robot to achieve time-optimal control. By imposing constraints during the planning phase and post-processing the optimal solution, some issues of non-smooth trajectories on real controllers are addressed. Experiments show that the framework can effectively utilize kinematic redundancy to optimize performance metrics at the planning level and generate feasible trajectories that can be executed on real hardware with satisfactory results. Additionally, due to the discrete dynamic programming basis, the algorithm can guarantee a globally optimal solution for a given resolution, allowing users to find the best balance between efficiency and planning time as needed.