High precision trajectory tracking control circuit using multi-axial coordination

摘要

The present invention provides a trajectory tracking control circuit for enabling the object of control to track any desired trajectory at high precision and high speed within the limits of the maximum permissible acceleration and the maximum permissible velocity. A velocity reference generator (2) generates velocity references Vi(₁) for the drive axes of the object of control on the basis of desired trajectory data and velocity reference data provided from an input unit (1). Acceleration detectors (3-i) (i = 1, 2, 3, ..., n), one of which is provided for each drive axis, detect accelerations from the velocity references and, if they exceed the permissible limit of acceleration or if the velocity references exceed that of velocity, comparators (4-i) generate acceleration excess signals or velocity excess signals, whichever are applicable. In response to this, multi-axial coordinators (5-i) determine, on the basis of the information of the acceleration excess signal and the velocity excess signal of each drive axis, a time-scale variation which enables every drive axis to satisfy the permissible limit of acceleration and that of velocity. Velocity reference converters (41) vary the velocity references in the time direction, and convert them into velocity signals which the drive motors can track.