2.4. Establishment of the Optimization Model
The aim of trajectory planning for manipulators used to grasp test tubes is to generate optimal motion paths that satisfy joint movement constraints based on a series of given key teach points. The resulting trajectory must not only precisely replicate the grasping path, but also deliver outstanding overall motion performance. However, focusing solely on minimizing execution time can result in excessive acceleration and deceleration, which can cause liquid to splash within test tubes or produce unstable balance readings. Conversely, prioritizing smoothness of the trajectory too highly may prolong operation cycles, thereby reducing experimental throughput. Therefore, the planning process must balance the following core optimization objectives. Minimum time, to improve grasping efficiency and ensure proper rhythm in the experimental workflow; Minimum energy consumption, to enhance the manipulator’s durability and operational economy during frequent start-stop and continuous tasks; Minimum jerk, to generate smooth trajectories under strict jerk constraints, effectively suppressing motion-induced vibration—an essential factor in preventing liquid splashing, ensuring stable grasping, and improving task success rates. In summary, trajectory planning for the test tube grasping task constitutes a comprehensive optimization problem that integrates multiple performance objectives under motion constraints.
where
denotes the simultaneous minimization of multiple objective functions.
is the vector of decision variables.
represents the
i-th objective function, and a total of
m objectives are optimized simultaneously. The notation “s.t.” denotes the constraints of the optimization problem.
and
represent the
j-th inequality constraint and the
k-th equality constraint, respectively.
Accordingly, this study considers three optimization objectives, expressed as follows:
(a) Time objective function
Execution time is considered as a basic task-efficiency indicator in trajectory planning. For a discretized trajectory with
n time intervals, the total execution time is defined as
where
denotes the time stamp of the
i-th discretization point. Minimizing
leads to shorter task execution duration.
(b) Energy-related objective function
In robotic manipulation tasks involving test tube grasping and weighing, trajectory planning must consider not only execution efficiency but also the actuation effort required by the robotic joints. From a physical perspective, the mechanical energy consumed by the manipulator during motion can be defined at the actuation level as the time integral of joint power. Specifically, the total mechanical energy consumption over a motion duration
T can be expressed as
where
N denotes the number of joints,
and
represent the driving torque and angular velocity of the
i-th joint, respectively, and
is the instantaneous joint power. Equation (9) provides a physically meaningful definition of mechanical energy consumption with units of joules (J).
However, directly minimizing the physical energy defined in Equation (9) within a trajectory optimization framework requires accurate torque modeling and full dynamic computation, which significantly increases computational complexity and sensitivity to modeling uncertainties. Moreover, in laboratory automation tasks such as test tube grasping and weighing, the robotic manipulator typically operates under moderate velocities, limited payload variation, and strict jerk constraints in order to suppress liquid sloshing and measurement disturbances.
Under these operating conditions, joint dynamics can be reasonably approximated as inertia-dominated, such that where denotes the equivalent rotational inertia of the i-th joint and is the joint angular acceleration. This approximation indicates a strong correlation between joint acceleration profiles and actuator effort. Nevertheless, it should be emphasized that acceleration-based quantities are not physically equivalent to the mechanical energy consumption defined in Equation (9), and therefore should not be interpreted as direct energy measures.
Motivated by this observation, an energy-related surrogate objective is introduced for optimization purposes. Instead of directly minimizing physical energy, the following acceleration-based proxy metric is employed:
where the term penalizes large joint accelerations throughout the duration of the motion. Although this objective is not dimensionally equivalent to physical energy, it is strongly correlated with actuator effort and energy consumption under inertia-dominated dynamics while offering favorable numerical properties for trajectory optimization.
In summary, Equation (9) defines the physical mechanical energy consumption at the actuation level, whereas Equation (10) serves as an optimization-oriented energy-related proxy objective. This formulation enables efficient multi-objective trajectory optimization while indirectly promoting reduced actuation effort and improved operational economy in repetitive test tube grasping and weighing tasks. Throughout this section, , , and denote joint position, velocity, and acceleration, respectively.
(c) Smoothness objective function
For the test tube grasping and weighing task, trajectory smoothness is a critical performance factor. Excessive variations in joint acceleration may induce mechanical vibrations, liquid sloshing inside test tubes, and transient disturbances in weighing measurements, ultimately degrading task success rates. To explicitly suppress such high-frequency motion components, trajectory smoothness is quantified by minimizing joint jerk, defined as the time derivative of joint acceleration.
The smoothness objective is formulated as
where
denotes the jerk of the
i-th joint,
is the joint position, and
T is the total motion duration. This objective penalizes rapid changes in joint acceleration and effectively constrains higher-order motion dynamics.
It should be noted that the jerk-based objective in Equation (11) does not correspond to a physical energy quantity, but instead serves as a motion-quality metric that directly reflects trajectory smoothness. By explicitly minimizing jerk, the generated trajectories exhibit reduced vibration excitation, improved grasping stability, and enhanced robustness against motion-induced disturbances. This is particularly important in laboratory automation scenarios where liquid handling accuracy and measurement stability are of primary concern.
(d) Normalized multi-objective aggregation function
The trajectory planning problem considered in this study involves multiple, potentially conflicting objectives, including execution time, actuation effort, and motion smoothness. As formulated in Equation (7), these objectives are optimized simultaneously within a multi-objective optimization framework, yielding a set of Pareto-optimal solutions that represent different trade-offs in the objective space.
To select a single executable trajectory from the obtained Pareto-optimal set for practical deployment, a posteriori. The decision-making strategy based on normalized objective aggregation is adopted. Specifically, the following aggregation function is defined:
where
denotes the
k-th objective function,
is the corresponding weighting coefficient that reflects the preference of the task, and
is a normalization factor. The normalization process ensures that all objectives are mapped to comparable, dimensionless scales, such that
within the feasible solution space. This prevents any single objective from dominating the aggregated score due to differences in physical units or numerical magnitude.
It is emphasized that Equation (12) is not used to replace the multi-objective optimization process itself. Instead, it serves solely as a post-processing criterion for selecting a compromise solution from the Pareto-optimal solution set. This separation preserves the integrity of the multi-objective formulation while enabling flexible adaptation to different operational priorities in practical robotic control.
Typical weight configurations employed for sensitivity analysis and engineering preference modeling are defined as follows:
Time-optimal: , ;
Energy-related optimal: , ;
Smoothness-optimal: , ;
Balanced optimization: ;