# US 2018/0088553 A1 · Control device, control program and control method

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

- Number: US 2018/0088553 A1
- Document ID: US20180088553A1
- Status: Published application
- Kind: A1
- Application number: 15/438,653
- Filed: 2017-02-21
- Published: 2018-03-29
- Earliest claimed: 2016-09-27
- Assignees: OMRON Corporation
- Applicants: OMRON Corporation
- Inventors: Tatsuya KOGA; Masahiro MURAI
- Web page: https://patentgrep.com/patent/US20180088553A1

## CPC

- 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)
- B23Q 17/0961: {by measuring power, current or torque of a motor}
- G05B 2219/37256: Wear, tool wear
- G05B 2219/39355: Observer, disturbance observer
- G05B 2219/41161: Adaptive friction compensation
- G05B 2219/41371: Force estimation using velocity observer
- G05B 2219/41376: Tool wear, flank and crater, estimation from cutting force
- G05B 2219/41379: Estimate torque from command torque and measured speed
- G05B 2219/42025: Pidaf, pid with acceleration and friction compensation
- G05B 2219/42338: Position tracking control
- Y02P 90/02: Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
- 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)
- 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
- Y02P: CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS

## Abstract

The invention provides a control device comprising: an actual value obtaining part, obtaining a torque actual value and a velocity actual value, wherein the torque actual value represents a torque generated by the driving source and the velocity actual value represents a velocity of the motion body; an inferring part, which calculates an external force inferred value and a velocity inferred value every other operation period based on the torque actual value by using an operation formula of a predetermined model representing driving of the motion body, wherein the external force inferring value represents an external force generated by the control system; and an output part, evaluating a reliability of the external force inferred value based on the velocity inferred value calculated together if the inferring part calculates the external inferred value, and effectively outputting the external force inferred value when it is judged that there is a designated reliability.

## Claims

### Claim 1

A control device that controls a control system which contains a motion body and a driving source driving the motion body, comprising:
an actual value obtaining part, obtaining a torque actual value and a velocity actual value, wherein the torque actual value represents a torque generated by the driving source for driving the motion body and the velocity actual value represents a velocity of the motion body;
an inferring part, which calculates an external force inferred value and a velocity inferred value every other operation period based on the torque actual value by using an operation formula of a predetermined model representing driving of the motion body, wherein the external force inferring value represents an external force generated by the control system, the velocity inferred value corresponds to the external force inferred value and represents a velocity of the motion body, and the operation formula contains items for updating the velocity inferred value and the external force inferred value such that the velocity actual value and the velocity inferred value are consistent; and
an output part, evaluating a reliability of the external force inferred value based on the velocity inferred value calculated together if the inferring part calculates the external inferred value, and effectively outputting the external force inferred value when it is judged that there is a designated reliability.

### Claim 2 (depends on 1)

The control device according to claim 1, wherein the output part judges that there is the designated reliability when a difference between the velocity inferred value and the corresponding velocity actual value is smaller than a predetermined value.

### Claim 3 (depends on 2)

The control device according to claim 2, wherein the output part outputs zero as the external force inferred value when judging that there is no designated reliability.

### Claim 4 (depends on 2)

The control device according to claim 2, wherein the output part maintains the output value of the external force inferred value output at the previous time when judging there is no designated reliability.

### Claim 5 (depends on 1)

The control device according to claim 1, wherein the operation formula contains a mass coefficient of the motion body and a viscosity resistance of the motion body as parameters.

### Claim 6 (depends on 1)

The control device according to claim 1, further comprising a statistical part, which, specific to the external force inferred value output by the output part in a designated period, divides the designated period into a plurality of periods and outputs distribution of a generation probability of the external force inferred value in each divided period.

### Claim 7

A control program that controls a control system which contains a motion body and a driving source driving the motion body, enabling a computer to execute the steps as follows:
obtaining a torque actual value and a velocity actual value, wherein the torque actual value represents a torque generated by the driving source for driving the motion body and the velocity actual value represents a velocity of the motion body;
calculating an external force inferred value and a velocity inferred value every other operation period based on the torque actual value by using an operation formula of a predetermined model representing driving of the motion body, wherein the external force inferring value represents an external force generated by the control system, the velocity inferred value corresponds to the external force inferred value and represents a velocity of the motion body, and the operation formula contains items for updating the velocity inferred value and the external force inferred value such that the velocity actual value and the velocity inferred value are consistent; and
evaluating a reliability of the external force inferred value based on the velocity inferred value calculated together if the external inferred value is calculated, and effectively outputting the external force inferred value when it is judged that there is a designated reliability.

### Claim 8

A control method that controls a control system which contains a motion body and a driving source driving the motion body, comprising the steps as follows:
obtaining a torque actual value and a velocity actual value, wherein the torque actual value represents a torque generated by the driving source for driving the motion body and the velocity actual value represents a velocity of the motion body;
calculating an external force inferred value and a velocity inferred value every other operation period based on the torque actual value by using an operation formula of a predetermined model representing driving of the motion body, wherein the external force inferring value represents an external force generated by the control system, the velocity inferred value corresponds to the external force inferred value and represents a velocity of the motion body, and the operation formula contains items for updating the velocity inferred value and the external force inferred value such that the velocity actual value and the velocity inferred value are consistent; and
evaluating a reliability of the external force inferred value based on the velocity inferred value calculated together if the external inferred value is calculated, and effectively outputting the external force inferred value when it is judged that there is a designated reliability.
