Trajectory generation system

摘要

A trajectory generation system is provided for operating a robot in response to a motion command. The robot is a multi-jointed manipulator with an end-effector that traverses a trajectory. A Cartesian trajectory generator converts the motion command into a requested Cartesian positions vector and a requested Cartesian velocities vector. A Jacobian matrix of the manipulator defines the relationship between the manipulator joint velocities vector and the manipulator Cartesian velocities vector. A requested joint velocities vector is computed from the requested Cartesian velocities vector by way of the inverse of the Jacobian matrix. The requested joint velocities vector defines a planned state vector for the manipulator.