发明名称 METHOD OF DETECTING A COLLISION OF MACHINE OPERATING PARTS DRIVEN BY SERVOMOTORS
摘要 PCT No. PCT/JP89/00245 Sec. 371 Date Oct. 25, 1989 Sec. 102(e) Date Oct. 25, 1989 PCT Filed Mar. 7, 1989 PCT Pub. No. WO89/08538 PCT Pub. Date Sep. 21, 1989.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.
申请公布号 US5119006(A) 申请公布日期 1992.06.02
申请号 US19890432743 申请日期 1989.10.25
申请人 FANUC LTD. 发明人 TORII, NOBUTOSHI;NAITO, YASUO;HAMURA, MASAYUKI;KATO, TETSUAKI
分类号 B25J9/16;B25J19/06;G05B19/19;G05D1/02 主分类号 B25J9/16
代理机构 代理人
主权项
地址