Electricity: motive power systems – Positional servo systems – Program- or pattern-controlled systems
Patent
1990-04-11
1993-05-25
Shoop, Jr., William M.
Electricity: motive power systems
Positional servo systems
Program- or pattern-controlled systems
210563, 210600, 210565, 210566, 318625, 318561, G05B 1910
Patent
active
052143627
DESCRIPTION:
BRIEF SUMMARY
TECHNICAL FIELD
The present invention relates to a 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.
BACKGROUND ART
During operation of a machine, if a foreign object enters the working region of a machine operating part, it interferes with the machine operating part, possibly impeding normal operation or even damaging the machine. Conventionally, various methods have been employed to avoid such an inconvenience.
For example, a collision of a machine operating part with a foreign object is detected by using a touch sensor mounted to the outer surface of the machine operating part. The provision of the sensor, however, entails an increase in the cost of the machine, and it is not possible to detect a collision of the machine operating part with a foreign object occurring outside the operable region of the sensor. In those types of machines in which the machine operating parts thereof are driven by servomotors, it is known to detect a collision of a machine operating part with a foreign object by detecting an increase in the driving current for the corresponding servomotor in excess of a predetermined discrimination current value caused by the collision. However, there is a considerable period of time from the occurrence of the collision until the servomotor driving current actually reaches the discrimination value. Therefore, a delay in the collision detection is inevitable and thus the collision can bring about greater damage due to the delay. Other types of machines, e.g., industrial robots are known in which a collision discriminating process is executed by a built-in computer in accordance with a sensor output or the detected value of the servomotor driving current. Namely, in machines of this type, the collision discriminating process is executed by the computer which is used for controlling the robot; in other words, both the collision discriminating process and the robot control are carried out by the same computer. The robot control, however, involves a variety of complicated data processings, and accordingly, execution periods of the control process and the collision discriminating process of the computer become inevitably long. Consequently, time passes until the collision discriminating process is completed after an occurrence of collision, thus further increasing the delay in the collision detection.
SUMMARY OF THE INVENTION
An object of the present invention is to provide a method which is capable of promptly detecting a collision of machine operating parts driven by servomotors with a foreign object and also capable 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.
To achieve the above object, according to the present invention, a method of detecting a collision and stopping drive of a machine driven by a servomotor, comprises the steps of: (a) periodically detecting a value of a collision discriminating parameter associated with a driving force of the servomotor; (b) periodically detecting an amount of change in the collision discriminating parameter value; (c) determining that a collision has occurred, when the amount of change in the collision discriminating parameter value becomes larger than a discrimination reference value; and (d) controlling the servomotor such that when an occurrence of a collision is detected, rotation of the servomotor is stopped.
According to the present invention, when the amount of change in the collision discriminating parameter value becomes larger than the discrimination reference value, it is determined that a collision has occurred in the machine driven by the servomotor, and rotation of the servomotor is stopped. Therefore, the occurrence of a collision can be quickly detected without using a special sensor, and the drive of the machine can be promptly stopped, whereby
REFERENCES:
patent: 4375611 (1983-03-01), Greig
patent: 4580085 (1986-04-01), Eto et al.
patent: 4582438 (1986-04-01), Okabayashi et al.
patent: 4594538 (1986-06-01), Schmitt
patent: 4599698 (1986-07-01), Fischer et al.
patent: 4682089 (1987-07-01), Tamari
patent: 4695941 (1987-09-01), Kumar
patent: 4712052 (1987-12-01), Omae et al.
patent: 4733149 (1988-03-01), Culberson
patent: 4794309 (1988-12-01), Saito et al.
patent: 4882528 (1989-11-01), Sogabe et al.
patent: 4904999 (1990-02-01), Klansnic et al.
patent: 4973895 (1990-11-01), Torii et al.
Hamura Masayuki
Naito Yasuo
Otsuka Kazuhisa
Torii Nobutoshi
Fanuc Limited
Masih Karen
Shoop Jr. William M.
LandOfFree
Method for detecting a collision and stopping drive of a machine does not yet have a rating. At this time, there are no reviews or comments for this patent.
If you have personal experience with Method for detecting a collision and stopping drive of a machine, we encourage you to share that experience with our LandOfFree.com community. Your opinion is very important and Method for detecting a collision and stopping drive of a machine will most certainly appreciate the feedback.
Profile ID: LFUS-PAI-O-899983