Method of iterative motion control

Abstract

Described is a method and device of a computational motion engine iteratively computing a numerical “jerk,” the motion derivative of acceleration, using real-time feedback from a system under motion control, to reach both a desired position and desired velocity of a next waypoint. Output from the motion engine is only desired acceleration, which is then passed to a motor driver, free of intermediate computations of either position or velocity. A second, inside feedback loop maintains desired acceleration or torque at the motor shaft based on the acceleration output of the motion engine, which may use non-linear correction tables. Waypoints comprising both position and velocity are inputs to the motion engine. Time to next waypoint is computed rather than provided as an input. Optimization of moves to the next waypoint is based on smoothest velocity change during the move. Embodiments include mechanical, two-axis SCARA arm motion systems.

Dependencies are inferred from the claim text.