Control device of robot and control method of robot
The disclosure is provided to shorten a total allowed cycle time of insertion or a press-fitting operation. A control device of a robot performing insertion or a press-fitting operation includes: a measuring part, measuring an elapsed time from a time point of starting a correcting operation in a case where the insertion or the press-fitting operation does not end normally; a calculating part, calculating a total remaining time of the correcting operation by subtracting a time from a start to an end of the correcting operation from a preset total allowed time of the correcting operation; a comparing part, comparing the remaining time with a required operation time which is an elapsed time from the start to the end of the correcting operation; and a control part, interrupting the correcting operation before the allowed time elapses in a case where the remaining time is less than the required operation time.
1. A control device of a robot that performs insertion or a press-fitting operation, comprising:
a measuring part, measuring an elapsed time from a time point of starting a correcting operation in a case where a position of the workpiece in a X direction and in an Y direction does not come to a press-fitting position corresponding to a hole part or a pushing force detected by a force sensor of the robot reaches a preset determination value, wherein the correcting operation includes a searching operation of searching for an insertion position or the press-fitting position, and a biting canceling operation of canceling biting of a workpiece during insertion or press-fitting by swinging the workpiece in at least one of X, Y and Z directions, wherein the press-fitting operation comprises the correcting operation and a pushing operation, and the pushing operation is performed to push the workpiece into the hole part after the correcting operation is completed;
a calculating part, calculating a total remaining time of the correcting operation by subtracting the elapsed time from a start to an end of one of the searching operation and the biting canceling operation included in the correcting operation from a preset total allowed time of the correcting operation;
a comparing part, comparing the total remaining time of the correcting operation with a required operation time of the correcting operation, wherein the required operation time of the correcting operation is the elapsed time from the start to the end of a remaining operation included in the correcting operation, wherein the remaining operation includes the other one of the searching operation and the biting canceling operation; and
a control part, interrupting the correcting operation and cancelling the remaining operation of the correcting operation before the total allowed time of the correcting operation elapses in a case where the total remaining time of the correcting operation is less than the required operation time of the correcting operation.
2. The control device of the robot according to claim 1 , comprising a force sensor, wherein the start and the end of the correcting operation are determined based on a value detected by the force sensor.
3. A control method of controlling a robot that performs insertion or a press-fitting operation, the control method comprising:
a step of measuring an elapsed time from a time point of starting a correcting operation in a case where a position of the workpiece in a X direction and in an Y direction does not come to a press-fitting position corresponding to a hole part or a pushing force detected by a force sensor of the robot reaches a preset determination value, wherein the correcting operation includes a searching operation of searching for an insertion position or the press-fitting position, and a biting canceling operation of canceling biting of a workpiece during insertion or press-fitting by swinging the workpiece in at least one of X, Y and Z directions, wherein the press-fitting operation comprises the correcting operation and a pushing operation, and the pushing operation is performed to push the workpiece into the hole part after the correcting operation is completed;
a step of calculating a total remaining time of the correcting operation by subtracting the elapsed time from a start to an end of one of the searching operation and the biting canceling operation included in the correcting operation from a preset total allowed time of the correcting operation;
a step of comparing the total remaining time of the correcting operation with a required operation time of the correcting operation, wherein the required operation time of the correcting operation is the elapsed time from the start to the end of a remaining operation included the correcting operation, wherein the remaining operation includes the other one of the searching operation and the biting canceling operation; and
a step of interrupting the correcting operation and cancelling the remaining operation of the correcting operation before the total allowed time of the correcting operation elapses in a case where the total remaining time of the correcting operation is less than the required operation time of the correcting operation.