US 12,440,977 B2
Control device, robot system, and control method for causing robot to execute work on workpiece
Mikito Hane, Yamanashi (JP)
Assigned to Fanuc Corporation, Yamanashi (JP)
Appl. No. 17/927,062
Filed by Fanuc Corporation, Yamanashi (JP)
PCT Filed May 24, 2021, PCT No. PCT/JP2021/019650
§ 371(c)(1), (2) Date Nov. 22, 2022,
PCT Pub. No. WO2021/241512, PCT Pub. Date Dec. 2, 2021.
Claims priority of application No. 2020-093562 (JP), filed on May 28, 2020.
Prior Publication US 2023/0202039 A1, Jun. 29, 2023
Int. Cl. B25J 9/16 (2006.01); B25J 9/00 (2006.01); B25J 5/02 (2006.01); B25J 11/00 (2006.01); G05B 19/418 (2006.01)
CPC B25J 9/1664 (2013.01) [B25J 9/0093 (2013.01); B25J 9/1653 (2013.01); B25J 5/02 (2013.01); B25J 11/005 (2013.01); G05B 19/4182 (2013.01); G05B 2219/39102 (2013.01)] 8 Claims
OG exemplary drawing
 
1. A control device configured to perform work on a workpiece by pressing a tool of a robot against the workpiece while an additional axis mechanism moves the robot and the workpiece relative to each other, the control device comprising a processor configured to:
acquire and transmit to the additional axis mechanism an additional axis movement command for causing the additional axis mechanism to move the robot or the workpiece;
generate a movement command for causing the robot to move the tool along a work target portion on the workpiece so as to follow movement of the robot or the workpiece by the additional axis mechanism, based on the additional axis movement command and operation plan data for causing the robot to perform an operation to move the tool along the work target portion;
based on the operation plan data or the additional axis movement command, acquire a vector in a direction along the work target portion, which inclines in response to the additional axis movement command with respect to a movement vector of the tool moved by the robot in accordance with the movement command;
determine a pressing direction in which the robot is to press the tool against the workpiece during the work based on the acquired vector;
when the tool is moved to one corrected target position in accordance with the generated movement command, acquire a first additional axis movement command for causing the additional axis mechanism to move the robot or the workpiece during moving the tool to a next corrected target position; and
generate the movement command for moving the tool to the next corrected target position by adding a movement command generated based on the first additional axis movement command to a movement command generated based on the operation plan data.