Empirical Evaluation of CHOMP for Autonomous Pick-and-Place Manipulation Using a UR5e Robot Arm: A MATLAB–ROS2 Hybrid Framework
Year: 2026
Type: article
Abstract: This study investigated the application of Covariant Hamiltonian Optimization for Motion Planning (CHOMP) in the MATLAB programming environment to an industrially relevant Universal Robots UR5e six-DOF manipulator. The parameters were set to be equal to those of the standard MoveIt2 CHOMP plugin, and the obstacle cost was computed directly in MATLAB using the Robotics System Toolbox’s forward kinematics function to obtain the end-effector position at each trajectory waypoint, which was then evaluated against a piecewise potential field defined over three spherical obstacles in the workspace. We executed five distinct picking task examples and one task over thirty trials, together with a sensitivity analysis over the weight parameter defining the optimization smoothness (i.e., weight/gamma). The mixed empirical results exposed major drawbacks of vanilla CHOMP under our parameter configuration. We achieved a collision-free result for only two of the five tasks, T-03 and T-05, with T-03 converging quickly in five iterations (0.16 s) and T-05 requiring 156 iterations and hitting the planning timeout limit of 10 s. Three tasks did not yield any collision-free result under the 10 s time limit. One of those three tasks, T-01, when running 30 random trial simulations after adding a tiny amount of noise to the start/end poses, yielded 0%, so all trials timed out on its planning 200-iteration limit with an invalid collision result. We analyzed the movement profile (position, velocity, and acceleration over time) of the trajectories generated during the experiments. Several examples exceed the UR5e velocity limit (180 deg/s) and the UR5e acceleration limit (400 deg/s2) by an order of magnitude, and peak values on T-02 reached up to 4731.92 deg/s2. With these chosen parameters, basic CHOMP is not industrially suitable for the UR5e robot or for the implementation of the empirical evaluation of CHOMP discussed in this paper. We also identified the modes of failure of basic CHOMP under these parameters and discuss relevant changes.
Source: Applied Sciences
DOI: 10.3390/app16178370
Authors: Kingsley Chigozie Eneh, Aytac Ugur Yerden
Institution: Gedik University
Language: English
Subfield: Control and Systems Engineering
Field: Engineering
Domain: Physical Sciences
Open Access status: gold
Estimated APC paid: $2,896
OpenAlex ID: W7204144076