Parallel link robot, parallel link robot system, and method of controlling parallel link robot

摘要

A parallel link robot includes a base, three servo motors disposed in the base, three arms, and a robot controller. Each of the three arms includes a first link and a second link that respectively include a first joint and a second joint. Each of the three arms is driven by a corresponding one of the three servo motors. The robot controller determines whether or not any of the first and second joints of the arms is dislocated on the basis of the torques of the three servo motors.

主权项

1. A parallel link robot comprising:
a base; a plurality of drive sources disposed in the base; a plurality of arms that each includes a link including a joint, each of the plurality of arms being driven by a corresponding one of the plurality of drive sources; and a dislocation detector that determines whether or not any of the joints of the arms is dislocated on the basis of a driving force of at least one of the plurality of drive sources, wherein the dislocation detector estimates a driving force of a predetermined one of the drive sources corresponding to a predetermined one of the arms in at least one of a dislocated state and a normal state, the dislocated state being a state in which the joint of the predetermined arm is dislocated, the normal state being a state in which the joint of the predetermined arm is normal, and the dislocation detector determines whether or not the joint of the predetermined arm is dislocated on the basis of the estimated driving force of the predetermined drive source and an actual driving force of the predetermined drive source.