# US 2023/0067098 A1 · Controller and program

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

- Number: US 2023/0067098 A1
- Document ID: US20230067098A1
- Status: Published application
- Kind: A1
- Application number: 17/759,994
- Filed: 2021-03-12
- Published: 2023-03-02
- Earliest claimed: 2020-03-18
- Assignees: Fanuc Corporation
- Applicants: Fanuc Corporation
- Inventors: Takashi KAWAIDA
- Web page: https://patentgrep.com/patent/US20230067098A1

## CPC

- B25J 9/1633: {compliant, force, torque control, e.g. combined with position control}
- B25J 9/1638: {compensation for arm bending/inertia, pay load weight/inertia}
- B25J 9/1664: {characterised by motion, path, trajectory planning}
- B25J 13/085: {Force or torque sensors (B25J13/082, B25J13/084 take precedence)}
- G05B 2219/40519: Motion, trajectory planning
- 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})
- 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

Provided are a controller and a program which optimize specifications of a motor, thereby enabling a reduction in costs related to an industrial robot. This controller controls a multi-axis robot for holding a workpiece and comprises: a planned operation angle position acquisition unit which acquires a planned operation angle position of the motor for each axis on the basis of a planned movement position of the workpiece; a torque calculation unit which calculates a load torque applied from the workpiece to the motor 140 on the basis of a load weight relating to the workpiece and a horizontal distance from the axial center of each axis to the workpiece; and a movement possibility determination unit which determines whether or not the motor can be moved to the planned operation angle position on the basis of a difference between the calculated load torque and an allowable torque of the motor.

## Claims

### Claim 1

A controller that controls a multi-axis robot configured to hold a workpiece, the controller comprising:
a planned operation angle position acquisition unit that acquires a planned operation angle position of a motor of each axis, based on a planned movement position of the workpiece;
a torque calculation unit that calculates a load torque applied from the workpiece to the motor, based on a load weight of the workpiece and a horizontal distance from an axial center of each axis to the workpiece; and
a movement enabling/disabling determination unit that determines, based on a difference between calculated load torque and an allowable torque of the motor, whether to allow the motor to move to the planned operation angle position.

### Claim 2 (depends on 1)

The controller according to claim 1, further comprising
a measuring unit that measures the load weight of the workpiece.

### Claim 3 (depends on 1)

The controller according to claim 1, further comprising
an operation execution unit that stops operation of the motor when the motor is not allowed to move to the planned operation angle position.

### Claim 4

A non-transitory computer readable media which non-transitorily stores a program that causes a computer to operate as a controller of a multi-axis robot configured to hold a workpiece, the program causing the computer to function as:
a planned operation angle position acquisition unit that acquires a planned operation angle position of a motor of each axis, based on a planned movement position of the workpiece;
a torque calculation unit that calculates a load torque applied from the workpiece to the motor, based on a load weight of the workpiece and a horizontal distance from an axial center of each axis to the workpiece; and
a movement enabling/disabling determination unit that determines, based on a difference between calculated load torque and an allowable torque of the motor, whether to allow the motor to move to the planned operation angle position.
