Robot control apparatus, robot control system, and robot control method
A robot control apparatus includes a drive controller configured to control a plurality of motors which are configured to drive a plurality of link mechanisms of a parallel link robot, respectively, and abnormality determination circuitry configured to determine based on state data of the plurality of motors whether at least one of collision of the parallel link robot and dislocation in the link mechanisms occurs.
1. A robot control apparatus comprising:
a drive controller configured to control a plurality of motors which are configured to drive a plurality of link mechanisms of a parallel link robot, respectively; and
abnormality determination circuitry configured to determine based on state data of the plurality of motors whether collision between the parallel link robot and an object outside of the parallel link robot occurs,
the drive controller being configured to control the plurality of motors so that the plurality of link mechanisms retreat when it is determined that the collision occurs,
wherein, when the abnormality determination circuitry determines that the collision occurs, the drive controller controls the plurality of motors such that movement of an attachment member which is connected to the plurality of link mechanisms and to which an end effector is configured to be attached is different between XY collision in an XY-axis directions and Z collision in a Z-axis direction in an operation space of an XYZ-axis orthogonal coordinate system in which the Z-axis direction corresponds to a vertical direction.
2. The robot control apparatus according to claim 1 , wherein the drive controller controls the plurality of motors so as to move the attachment member to a predetermined position when the abnormality determination circuitry determines that the XY collision occurs.
3. The robot control apparatus according to claim 1 , wherein the drive controller controls the plurality of motors so as to stop movement of the attachment member when the abnormality determination circuitry determines that the XY collision occurs.
4. The robot control apparatus according to claim 1 , wherein the drive controller controls the plurality of motors so as to limit output torques output by the plurality of motors and move the attachment member to a predetermined position when the abnormality determination circuitry determines that the Z collision occurs.
5. The robot control apparatus according to claim 1 , wherein the state data of the plurality of motors includes motor torque, motor position, and motor speed of the plurality of motors.
6. The robot control apparatus according to claim 1 , wherein the plurality of motors include a plurality of linear motors.
7. The robot control apparatus according to claim 1 , wherein the drive controller controls the plurality of motors so as to move a movable portion of the parallel link robot to a position separated from a collision point by a predetermined distance when it is determined that the collision occurs.
8. The robot control apparatus according to claim 1 ,
wherein the abnormality determination circuitry is configured to determine whether the collision occurs by comparing an external force acting on the plurality of link mechanisms with a threshold value, and
wherein the drive controller controls the plurality of motors to retreat a movable portion of the parallel link robot to a position separated from the external force in a direction of the external force by a predetermined separation distance set in advance when it is determined that the collision occurs.
9. The robot control apparatus according to claim 1 , further comprising:
encoder units configured to detect positions of rotors of the plurality of motors,
wherein the abnormality determination circuitry is configured to determine whether the collision occurs by comparing an external force acting on the plurality of link mechanisms with a threshold value, the external force is estimated based on:
the state data including torque commands output by the drive controller to the plurality of motors; and
detected positions of the plurality of motors detected by the encoder units.
10. A robot control system comprising:
a parallel link robot comprising;
a plurality of link mechanisms; and
a plurality of motors configured to drive the plurality of link mechanisms, respectively; and
a robot control apparatus comprising:
a drive controller configured to control the plurality of motors; and
abnormality determination circuitry configured to determine based on state data of the plurality of motors whether collision between the parallel link robot and an object outside of the parallel link robot occurs,
the drive controller being configured to control the plurality of motors so that the plurality of link mechanisms retreat when it is determined that the collision occurs,
wherein the drive controller controls the plurality of motors so as to move a movable portion of the parallel link robot to a position separated from a collision point by a predetermined distance when it is determined that the collision occurs.
11. The robot control system according to claim 10 ,
wherein the abnormality determination circuitry is configured to determine whether the collision occurs by comparing an external force acting on the plurality of link mechanisms with a threshold value, and
wherein the drive controller controls the plurality of motors to retreat a movable portion of the parallel link robot to a position separated from the external force in a direction of the external force by a predetermined separation distance set in advance when it is determined that the collision occurs.
12. The robot control system according to claim 10 , further comprising:
encoder units configured to detect positions of rotors of the plurality of motors,
wherein the abnormality determination circuitry is configured to determine whether the collision occurs by comparing an external force acting on the plurality of link mechanisms with a threshold value, the external force is estimated based on:
the state data including torque commands output by the drive controller to the plurality of motors; and
detected positions of the plurality of motors detected by the encoder units.
13. A robot control apparatus comprising:
a drive controller configured to control a plurality of motors which are configured to drive a plurality of link mechanisms of a parallel link robot, respectively;
abnormality determination circuitry configured to determine based on state data of the plurality of motors whether collision between the parallel link robot and an object outside of the parallel link robot occurs; and
encoder units configured to detect positions of rotors of the plurality of motors,
wherein the abnormality determination circuitry is configured to determine whether the collision occurs by comparing an external force acting on the plurality of link mechanisms with a threshold value, the external force is estimated based on:
the state data including torque commands output by the drive controller to the plurality of motors; and
detected positions of the plurality of motors detected by the encoder units.