# US 2023/0202039 A1 · Control device, robot system, and control method for causing robot to execute work on workpiece

> Agents: this data is available as JSON from the patentgrep API and MCP server — see https://patentgrep.com/llms.txt

- Number: US 2023/0202039 A1
- Document ID: US20230202039A1
- Status: Published application
- Kind: A1
- Application number: 17/927,062
- Filed: 2021-05-24
- Published: 2023-06-29
- Earliest claimed: 2020-05-28
- Assignees: Fanuc Corporation
- Applicants: Fanuc Corporation
- Inventors: Mikito Hane
- Web page: https://patentgrep.com/patent/US20230202039A1

## CPC

- B25J 9/1664: {characterised by motion, path, trajectory planning}
- B23Q 15/0075: {Controlling reciprocating movement, e.g. for planing-machine}
- B25J 9/0093: {co-operating with conveyor means}
- B25J 9/1633: {compliant, force, torque control, e.g. combined with position control}
- B25J 9/1653: {parameters identification, estimation, stiffness, accuracy, error analysis}
- B25J 5/02: travelling along a guideway
- B25J 11/005: {Manipulators for mechanical processing tasks}
- G05B 19/4182: {manipulators and conveyor only}
- G05B 2219/39102: Manipulator cooperating with conveyor
- G05B 2219/39198: Manipulator used as workpiece handler and for machining operation
- B25J: MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES ({manipulators specially adapted for use in surgery A61B34/70; manipulators used in cleaning hollow articles B08B9/04}; manipulators associated with rolling mills B21B39/20; manipulators associated with forging machines B21J13/10; {manipulators associated with picking-up and placing mechanisms B23P19/007}; means for holding wheels or parts thereof B60B30/00; {vehicles with ground-engaging propulsion means, e.g. walking members B62D57/02, B62D57/032; devices for picking-up and depositing articles or materials between conveyors B65G47/90, B65G47/91; manipulators with gripping or holding means for transferring packages B65H67/065}; cranes B66C; {manipulators used in the protection or supervision of pipe-line installations F17D5/00; walking equipment adapted for nuclear steam-generators F22B37/006}; manipulators specially adapted for, or associated with, nuclear reactors G21C; {apparatus used for handling wafers during manufacture or treatment of semiconductor H10P72/50})
- B23Q: DETAILS, COMPONENTS, OR ACCESSORIES FOR MACHINE TOOLS, e.g. ARRANGEMENTS FOR COPYING OR CONTROLLING (tools of the kind used in lathes or boring machines B23B27/00); MACHINE TOOLS IN GENERAL CHARACTERISED BY THE CONSTRUCTION OF PARTICULAR DETAILS OR COMPONENTS; COMBINATIONS OR ASSOCIATIONS OF METAL-WORKING MACHINES, NOT DIRECTED TO A PARTICULAR RESULT
- G05B: CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS (systems for controlling or regulating non-electric variables G05D; systems for regulating electric or magnetic variables G05F; control devices or systems insofar as characterised by mechanical features only G05G)

## Abstract

When performing work on a workpiece with a tool of a robot while the robot and the workpiece are moved relative to each other by an additional axis mechanism, the tool is to be pressed against the workpiece from an appropriate direction. A control device includes an additional axis movement amount acquisition section that acquires an additional axis movement amount, a command generation section that generates a movement command for a robot based on operation plan data of the robot and the additional axis movement amount, a vector acquisition section that, based on the operation plan data or the additional axis movement amount, acquires a vector in a direction along a work target portion of a workpiece, and a pressing direction determination section that determines a pressing direction in which the robot is to press the tool against the workpiece during work, using the vector acquired by the vector acquisition section.

## Claims

### Claim 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:
an additional axis movement amount acquisition section configured to acquire an additional axis movement amount by which the additional axis mechanism moves the robot or the workpiece;
a command generation section configured to 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 amount and operation plan data for causing the robot to perform an operation to move the tool along the work target portion;
a vector acquisition section configured to, based on the operation plan data or the additional axis movement amount, acquire a vector in a direction along the work target portion, which inclines in response to the additional axis movement amount with respect to a movement vector of the tool moved by the robot in accordance with the movement command; and
a pressing direction determination section configured to determine a pressing direction in which the robot is to press the tool against the workpiece during the work, using the vector acquired by the vector acquisition section.

### Claim 2 (depends on 1)

The control device of claim 1, wherein the operation plan data includes a plurality of target positions at which the robot is to position the tool during the operation, and a movement path between two of the target positions,
wherein the vector acquisition section acquires, as the vector, a vector in a direction of the movement path.

### Claim 3 (depends on 2)

The control device of claim 2, wherein position data of the plurality of target positions, and data of the movement path are acquired by teaching the operation to the robot while the additional axis mechanism stops the robot or the workpiece.

### Claim 4 (depends on 1)

The control device of claim 1, wherein the vector acquisition section acquires the vector by subtracting a movement vector, along which the additional axis mechanism moves the robot or the workpiece by the additional axis movement amount, from the movement vector of the tool.

### Claim 5 (depends on 1)

The control device of claim 1, wherein the pressing direction determination section determines a direction orthogonal to the vector as the pressing direction.

### Claim 6 (depends on 1)

The control device of claim 1, wherein the command generation section further generates a force control command for controlling a pressing force, by which the robot presses the tool against the workpiece in the pressing direction determined by the pressing direction determination section, to a predetermined target value.

### Claim 7 (depends on 1)

A robot system comprising:
a robot including a tool;
an additional axis mechanism configured to move the robot and the workpiece relative to each other; and
the control device of claim 1.

### Claim 8

A method of performing 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 method comprising:
acquiring an additional axis movement amount by which the additional axis mechanism moves the robot or the workpiece;
generating 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 amount 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 amount, acquiring a vector in a direction along the work target portion, which inclines in response to the additional axis movement amount with respect to a movement vector of the tool moved by the robot in accordance with the movement command; and
determining a pressing direction in which the robot is to press the tool against the workpiece during the work, using the acquired vector.
