Patent ID: 8489236
Filing Date: 2013-07-16
Classification: G05B,Y02P,Y10T

Abstract:
1. A control apparatus of a robot arm, for controlling a motion of the robot arm, the control apparatus comprising: an end effector attached to a main body of the robot arm touched and operated by a person and caused to perform a task; a grip portion attached to the main body of the robot arm so as to be separated from the end effector with a gap of a predetermined size being provided therebetween, the grip portion being relatively shiftable with respect to the end effector and being gripped by the person during the operation; a relative positional information acquisition unit that acquires information on a relative position of the grip portion with respect to the end effector during the operation; a tracking control unit that obtains a shift amount of the robot arm in order to perform tracking control of shifting the robot arm in accordance with an amount of variation of a size of the gap between the end effector and the grip portion so that the information on the relative position acquired by the relative positional information acquisition unit is within a range of a predetermined threshold; a control unit that controls the robot arm so as to shift in accordance with the amount of variation of the size of the gap between the end effector and the grip portion, based on the shift amount of the robot arm obtained by the tracking control unit; a fixing portion including a fixing member shiftable between a fixed position where the fixing member is in contact with the end effector and the grip portion to fix the end effector and the grip portion and restrict relative shift between the end effector and the grip portion, and an accommodated position where the fixed member is accommodated in the end effector or in the grip portion and allows the end effector and the grip portion to shift relatively, the fixing portion maintaining the size of the gap between the end effector and the grip portion when the fixing member is located at the fixed position; a mode switch unit that switches between a “teaching mode” and a “playback mode” as a control mode of the robot arm; a fixing switch unit that switches between a fixing state where, when the mode switch unit switches to the “playback mode”, the fixing portion is located at the fixed position to fix the end effector and the grip portion and maintain the size of the gap between the end effector and the grip portion, and a relatively shiftable state where, when the mode switch unit switches to the “teaching mode”, the fixing portion is located at the accommodated position and allows the end effector and the grip portion to shift relatively without maintaining the size of the gap between the end effector and the grip portion; an arm tip positional information acquisition unit that acquires positional information on the end effector of the robot arm during the “teaching mode”; and a desired trajectory generation unit that generates a desired trajectory of the end effector of the robot arm during the “teaching mode”, based on the arm tip positional information acquired by the arm tip positional information acquisition unit and the information on the relative position acquired by the relative positional information acquisition unit, wherein the control unit causes the tracking control unit to perform tracking control on the robot arm moving in accordance with a teaching operation of the person when the mode switch unit switches to the “teaching mode”, and controls the robot arm in accordance with the desired trajectory generated by the desired trajectory generation unit when the mode switch unit switches to the “playback mode”.