Dual arm robot

摘要

The dual arm robot includes a first arm including a first hand, a first visual sensor and a first force sensor, and a second arm including a second hand, a second visual sensor and a second force sensor, uses each visual sensor to detect positions of a lens barrel and a fixed barrel to hold and convey them to a central assembling area, uses the first visual sensor to measure a position of a flexible printed circuits to insert the flexible printed circuits into the fixed barrel, and uses outputs of the force sensors to fit and assemble the fixed barrel onto the lens barrel under force control. The dual arm robot converts a position coordinate of a workpiece detected by each visual sensor to a robot coordinate to calculate a trajectory of each hand and drive each arm, to thereby realize cooperative operation of the two arms.

主权项

1. A dual arm robot causing a first arm and a second arm to cooperatively operate, comprising:
the first arm including a first hand and a first visual sensor; the second arm including a second hand and a second visual sensor; and a controller, wherein, in an operation for assembling a first workpiece and a second workpiece by using the first arm and the second arm, when the first visual sensor is able to detect the first workpiece and the second visual sensor is able to detect the second workpiece, the first visual sensor detects the first workpiece held by the first arm and the second visual sensor detects the second workpiece held by the second arm, wherein, in the operation, when the first visual sensor is unable to detect the first workpiece, the second visual sensor detects a position coordinate of the first workpiece, or when the second visual sensor is unable to detect the second workpiece, the first visual sensor detects a position coordinate of the second workpiece, and wherein the controller uses a robot coordinate system containing position coordinates of the first and second hands, a first visual sensor coordinate system containing the position coordinate of a workpiece detected by the first visual sensor, and a second visual sensor coordinate system containing the position coordinate of a workpiece detected by the second visual sensor, so that the controller converts the position coordinate of the workpiece from the first and second visual sensor coordinate systems to the robot coordinate system and controls movements of the first and second arms in the operation for assembling the first workpiece and the second workpiece.