Method for detecting a collision and stopping drive of a machine driven by servomotors

Abstract

A collision detection/drive stoppage method capable of promptly detecting a collision of machine operating parts driven by servomotors with a foreign object, and of promptly stopping drive of the machine operating parts upon detection of a collision, thereby preventing or lessening damage to a machine, etc., caused by the collision. A digital signal processor of an axis controller, forming a software servo system, periodically calculates a velocity deviation (.epsilon.v) in accordance with a command velocity (Vc) calculated based on a command from a main computer and an actual motor velocity (V) from a pulse coder of the servomotor (S2), determines whether the absolute value (.vertline..epsilon.v-.epsilon.v'.vertline.) of the difference between the velocity deviation of the current servo control period and that of the previous control period is smaller than a collision discriminating reference value (ERR) (S3), and causes an alarm to be displayed and at the same time delivers a torque command having a value of zero to stop rotation of the servomotor (S8, S9) when the absolute value is larger than the reference value.

Dependencies are inferred from the claim text.