# US 2018/0200882 A1 · Servomotor control device, servomotor control method, and computer readable recording medium

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

- Number: US 2018/0200882 A1
- Document ID: US20180200882A1
- Status: Published application
- Kind: A1
- Application number: 15/862,166
- Filed: 2018-01-04
- Published: 2018-07-19
- Earliest claimed: 2017-01-13
- Assignees: Fanuc Corporation
- Applicants: Fanuc Corporation
- Inventors: Shougo SHINODA; Satoshi IKAI
- Web page: https://patentgrep.com/patent/US20180200882A1

## CPC

- B25J 9/1085: {positioning by means of shape-memory materials (shape memory actuators F03G7/06)}
- B25J 3/04: involving servo mechanisms (servo-actuated heads B25J15/02)
- B25J 9/1633: {compliant, force, torque control, e.g. combined with position control}
- G05B 19/404: characterised by control arrangements for compensation, e.g. for backlash, overshoot, tool offset, tool wear, temperature, machine construction errors, load, inertia (G05B19/19, G05B19/41 take precedence)
- G05B 2219/41138: Torque compensation
- 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

A servomotor control device includes: a driven body configured to be driven by a servomotor; a connection mechanism configured to connect the servomotor and the driven body; a position command generation unit configured to generate a position command value for the driven body; a motor control unit configured to control the servomotor using the position command value; a force estimation part configured to estimate a force estimated value which is a drive force acting on the driven body at a connecting part with the connection mechanism; and a compensation amount generation part configured to generate a compensation amount for compensation the position command value generated by the position command generation part, using a product of the force estimated value and a coefficient indicating a physical constant, in which the coefficient indicating the physical constant changes by the force estimated value or a magnitude of the compensation amount thus generated.

## Claims

### Claim 1

A servomotor control device, comprising:
a servomotor;
a driven body configured to be driven by the servomotor;
a connection mechanism configured to connect the servomotor and the driven body to transfer power of the servomotor to the driven body;
a position command generation unit configured to generate a position command value for the driven body;
a motor control unit configured to control the servomotor using the position command value;
a force estimation unit configured to estimate a force estimated value which is drive force acting on the driven body at a connecting part with the connection mechanism;
a compensation amount generation part configured to generate a compensation amount for compensating the position command value generated by the position command generation unit, using a product of the force estimated value and a coefficient indicating a physical constant; and
a coefficient setting unit configured to change the coefficient indicating the physical constant by the force estimated value or a magnitude of the compensation amount generated.

### Claim 2 (depends on 1)

The servomotor control device according to claim 1,
wherein the compensation amount generation part sets, as the compensation amount, the sum of a product of the force estimated value and a first coefficient, and a product of the force estimated value, distance from the servomotor until the connecting part, and a second coefficient, and
wherein the product of the force estimated value and the first coefficient is a product of the force estimated value and a coefficient indicating a physical constant.

### Claim 3 (depends on 1)

The servomotor control device according to claim 1, wherein the coefficient indicating the physical constant is continuously or discretely made smaller based on the force estimated value estimated by the force estimation unit, upon an absolute value for the force estimated value becoming large than a predetermined value.

### Claim 4 (depends on 1)

The servomotor control device according to claim 1, wherein the coefficient indicating the physical constant is continuously or discretely made smaller based on the compensation amount generated by the compensation amount generation part, upon an absolute value for the compensation amount that was generated becoming greater than a predetermined value.

### Claim 5

A servomotor control method for a servomotor control device including:
a servomotor;
a driven body configured to be driven by the servomotor; and
a connection mechanism configured to connect the servomotor and the driven body to transfer power of the servomotor to the driven body,
the method comprising the steps of:
generating a position command value for the driven body;
estimating a force estimated value which is a drive force acting on the driven body at a connecting part with the connection mechanism;
compensating the position command value by a compensation amount generated using a product of the force estimated value thus estimated and a coefficient indicating a physical constant; and
controlling the servomotor using the position command value thus compensated,
wherein the coefficient indicating the physical constant changes by the force estimated value or a magnitude of the compensation amount thus generated.

### Claim 6 (depends on 5)

The servomotor control method according to claim 5, wherein the compensation value for compensating the position command value is the sum of a product of the force estimated value and a first coefficient, and a product of the force estimated value, distance from the servomotor until the connecting part, and a second coefficient, and
wherein the product of the force estimated value and first coefficient is a product of the force estimated value and a coefficient indicating a physical constant.

### Claim 7 (depends on 5)

The servomotor control method according to claim 5, wherein the coefficient indicating the physical constant is continuously or discretely made smaller based on the estimated value thus estimated, upon an absolute value for the force estimated value becoming greater than a predetermined value.

### Claim 8 (depends on 5)

The servomotor control method according to claim 5, wherein the coefficient indicating the physical constant is continuously or discretely made smaller based on the compensation amount thus generated, upon an absolute value for the compensation amount thus generated becoming greater than a predetermined value.

### Claim 9

A non-transitory computer readable recording medium encoded with a program for servomotor control that causes a computer to execute servomotor control of a servomotor control device including: a servomotor;
a driven body configured to be driven by the servomotor; and
a connection mechanism configured to connect the servomotor and the driven body to transfer power of the servomotor to the driven body, the program causing the computer to execute processing of:
generating a position command value for the driven body;
estimating a force estimated value that is a drive force acting on the driven body at a connecting part with the connection mechanism;
compensating the position command value with a compensation amount generated using a product of the force estimated value thus estimated and a coefficient indicating a physical constant; and
controlling the servomotor using the position command value thus compensated,
wherein the coefficient indicating the physical constant changes by the force estimated value or magnitude of the compensation amount thus generated.
