Method of detecting a collision of machine operating parts driven by servomotors

• US 5,119,006 A
• Filed: 10/25/1989
• Issued: 06/02/1992
• Est. Priority Date: 03/10/1988
• Status: Expired due to Fees

• Current Assignee: Fanuc Ltd (Fanuc Corporation)
• Original Assignee: Fanuc Ltd (Fanuc Corporation)
• Inventors: Hamura, Masayuki, Kato, Tetsuaki, Naito, Yasuo, Torii, Nobutoshi
• Primary Examiner(s): IP, SHIK LUEN PAUL
• Application Number:
  US07/432,743
• Time in Patent Office: 951 Days
• Field of Search: 318/560-636, 318/640, 364/513, 364/474.2, 364/461, 364/460, 901/2, 901/3, 901/9, 901/12, 901/13, 901/16-23
• US Class Current: 318/640
• CPC Class Codes: B25J 19/06 Safety devices
• CPC Class Codes: B25J 19/063 working only upon contact with an outside object
• CPC Class Codes: B25J 9/1676 Avoiding collision or forbidden zones

Abstract

A collision detecting method is provided which is capable of promptly detecting a collision of robot operating parts driven by servomotors, e.g., robot arms, with a foreign object. Prompt detection of such collisions aids in preventing or limiting damage to a machine, etc. by the collision. A digital signal processor of an axis controller (2) of FIG. 1, as part of a software servo system, calculates a velocity command and a torque command in accordance with a movement command supplied from a main computer (1), to periodically carry out servo control for individual axes of the robot. The digital signal processor also determines whether the torque command or a velocity deviation between the velocity command and an actual velocity of a servomotor (13b) is greater than a respective predetermined value. When the torque command or velocity deviation becomes greater than the respective predetermined value, the collision detecting method determines that a collision of the robot operating part (13a) with a foreign object or the like has occurred, and the operation of the servomotor is stopped.

Claims

1. A method of detecting a collision of a machine operating part driven by a servomotor, comprising the steps of:

(a) detecting a predetermined collision discriminating parameter relating to a driving force of the servomotor at first predetermined periods;

(b) detecting an amount of change of said collision discriminating parameter at second predetermined periods; and

(c) determining that the collision of the machine operating part has occurred when the amount of change of the collision discriminating parameter detected in said step (b) becomes greater than a predetermined value.

2. The method according to claim 1, wherein the machine has a main computer, and wherein said step (a) comprises setting the first predetermined period to a value shorter than a period at which various control actions, including an output of a movement command to the servomotor, are carried out by the main computer of the machine to which said method is applied.

3. The method according to claim 1, wherein said step (b) utilizes the second predetermined period by setting it to a value equal to the first predetermined period of said step (a), and wherein said step (b) comprises detecting a difference between a value of the collision discriminating parameter detected in a previous predetermined period and a value of the same parameter detected in a current predetermined period.

10. The method according to claim 1, wherein said steps (a)-(c) utilize the collision discriminating parameter comprising a deviation between a command position and an actual position of the servomotor.

4. A method of detecting a collision of a machine operating part driven by a servomotor, comprising the steps of:

(a) detecting a predetermined collision discriminating parameter relating to a driving force of the servomotor at first predetermined periods;

(b) detecting an amount of change of said collision discriminating parameter at second predetermined periods; and

(c) determining that the collision of the machine operating part has occurred when the amount of change of the collision discriminating parameter detected in said step (b) becomes greater than a predetermined value,

wherein said steps (a)-(c) utilize the collision discriminating parameter comprising a torque command value supplied to the servomotor.

5. A method of detecting a collision of a machine operating part driven by a servomotor, comprising the steps of:

(a) detecting a predetermined collision discriminating parameter relating to a driving force of the servomotor at first predetermined periods;

(b) detecting an amount of change of said collision discriminating parameter at second predetermined periods; and

(c) determining that the collision of the machine operating part has occurred when the amount of change of the collision discriminating parameter detected in said step (b) becomes greater than a predetermined value,

wherein said steps (a)-(c) utilize the collision discriminating parameter comprising a deviation between a velocity command supplied to the servomotor and an actual velocity of the servomotor.

6. A method of detecting a collision of a machine operating part driven by a servomotor, comprising the steps of:

(a) detecting a predetermined collision discriminating parameter relating to a driving force of the servomotor at first predetermined periods;

(b) detecting an amount of change of said collision discriminating parameter at second predetermined periods; and

(c) determining that the collision of the machine operating part has occurred when the amount of change of the collision discriminating parameter detected in said step (b) becomes greater than a predetermined value,

wherein the machine has a main computer,

wherein said step (a) comprises setting the first predetermined period to a value shorter than a period at which various control actions, including an output of a movement command to the servomotor, are carried out by the main computer of the machine to which said method is applied, and

wherein said steps (a)-(c) utilize the collision discriminating parameter comprising a torque command value supplied to the servomotor.

7. A method of detecting a collision of a machine operating part driven by a servomotor, comprising the steps of:

(a) detecting a predetermined collision discriminating parameter relating to a driving force of the servomotor at first predetermined periods;

(b) detecting an amount of change of said collision discriminating parameter at second predetermined periods; and

(c) determining that the collision of the machine operating part has occurred when the amount of change of the collision discriminating parameter detected in said step (b) becomes greater than a predetermined value,

wherein said step (b) utilizes the second predetermined period by setting it to a value equal to the first predetermined period of said step (a), and

wherein said step (b) comprises detecting a difference between a value of the collision discriminating parameter detected in a previous predetermined period and a value of the same parameter detected in a current predetermined period, and

wherein said steps (a)-(c) utilize the collision discriminating parameter comprising a torque command value supplied to the servomotor.

8. A method of detecting a collision of a machine operating part driven by a servomotor, comprising the steps of:

(a) detecting a predetermined collision discriminating parameter relating to a driving force of the servomotor at first predetermined periods;

(b) detecting an amount of change of said collision discriminating parameter at second predetermined periods; and

(c) determining that the collision of the machine operating part has occurred when the amount of change of the collision discriminating parameter detected in said step (b) becomes greater than a predetermined value,

wherein the machine has a main computer,

wherein said step (a) comprises setting the first predetermined period to a value shorter than a period at which various control actions, including an output of a movement command to the servomotor, are carried out by the main computer of the machine to which said method is applied, and

wherein the collision discriminating parameter comprises a deviation between a velocity command supplied to the servomotor and an actual velocity of the servomotor.

9. A method of detecting a collision of a machine operating part driven by a servomotor, comprising the steps of:

(a) detecting a predetermined collision discriminating parameter relating to a driving force of the servomotor at first predetermined periods;

(b) detecting an amount of change of said collision discriminating parameter at second predetermined periods; and

(c) determining that the collision of the machine operating part has occurred when the amount of change of the collision discriminating parameter detected in said step (b) becomes greater than a predetermined value,

wherein said step (b) utilizes the second predetermined period by setting it to a value equal to the first predetermined period of said step (a),

wherein said step (b) comprises detecting a difference between a value of the collision discriminating parameter detected in a previous predetermined period and a value of the same parameter detected in a current predetermined period, and

wherein the collision discriminating parameter comprises a deviation between a velocity command supplied to the servomotor and an actual velocity of the servomotor.