The invention relates to the field of mechanical arms of
foot type robots, in particular to an inverse multi-solution selection and
time optimal trajectory planning algorithm of a mechanical arm. According to the
algorithm, the most appropriate group of solutions can be rapidly selected from multiple inverse solutions according to the current
pose of the mechanical arm, so that singular patterns are effectively avoided, smooth switching between different inverse solutions is achieved, and continuity and non-oscillation of control and action of the mechanical arm are guaranteed; and a trajectory with optimal time is planned by using a
trajectory planning method combining a heptatic polynomial and conditional
proportional control, so that smooth, continuous and derivable joint angles, angular velocities, angular accelerations and angular jerk are ensured; and meanwhile, multi-target and multi-constraint conditions are met, and the specification of an
actuator is met; and the constraint condition comprise joint
angular velocity maximum value constraint or joint
angular acceleration maximum value constraint, and the like. According to the
algorithm, the calculation amount of multi-solution selection and
trajectory planning is greatly reduced, real-time and efficient
time optimal trajectory planning can be realized, and the algorithm can be popularized and applied to a low-calculation-
power controller.