摘要 |
The robot (1) comprises a hand (4), a force sensor (5), an X-axis base (6), a Z-axis base (7) and a Y-axis base (8). A control circuit for the robot includes a memory unit (11) for storing teaching and other data, and a microprocessor (12) which reads out the teaching data from the memory, generates a motion route command for the hand, sends motion route data to a position control unit (13), and sends open and close commands to the hand via a hand open close unit (17). The microprocessor also generates teaching data in response to hand positions detected by a hand position detection unit (14) and stores the teaching data in the memory. A position control unit (13) feeds out a plurality of pulses (Vx, Vy, and Vz) which are converted from displacement values for each axis, in response to the motion route command sent from the microprocessor, to control the position or speed of the hand. A hand position detection unit (14) receives signals (Px, Py, and Pz) generated from the drive sources for the three axes for detecting the current position of the hand. A force control unit generates a control command based on the outputs (Ma to Mf) from the force sensor, and generates follow-up displacement values (PFx, PFy, and PFz). An arm drive unit (16) operates each drive source on the basis of displacement values from the position control unit and the follow-up displacement values from the force control unit. |