# US 2006/0186845 A1 · Servo controller

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

- Number: US 2006/0186845 A1
- Document ID: US20060186845A1
- Status: Published application
- Kind: A1
- Application number: 10/552,825
- Filed: 2003-04-11
- Published: 2006-08-24
- Earliest claimed: 2003-04-11
- Assignees: Mitsubishi Denki Kabushiki Kaisha
- Inventors: Kei Terada; Tetsuaki Nagano; Kazutaka Takahashi; Takashi Isoda
- Web page: https://patentgrep.com/patent/US20060186845A1

## CPC

- G05B 19/19: characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path
- G05B 2219/41205: Compensation circuit in speed feedback loop
- 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

In a servo controller according to the invention, a position feedback correction unit (3) calculates a first-axis position feedback signal (pmfb1) based on a first-axis position (pm1) as a self-axis position, and a second-axis position (pm2) as an other-axis position; and a deviation between a model position (pal) and the first-axis position feedback signal (pmfb1) is inputted from a subtracter (5) to a position control unit (4), which performs positional control to output a velocity command. A velocity feedback correction unit (6) calculates a first-axis velocity feedback signal (wmfb1) from a first-axis velocity (wm1) as the self-axis velocity, and a second-axis velocity (wm2) as the other-axis velocity; and the velocity control unit (8) adds a model velocity (wa1) and the velocity command outputted from the position control unit (5), and subtracts the first-axis velocity feedback signal (wmfb1) therefrom, and outputs a feedback torque command (Tfb1) based on the corrected velocity command.

## Claims

### Claim at position 1

1-11. (canceled)

### Claim 12

A servo controller comprising:
a position feedback correction unit for correcting a position feedback signal by adding a between-axes positional deviation, filtered and gained, that is the difference between a self-axis position and an other-axis position, to the gained self-axis position;
a position control unit for performing, according to a corrected position feedback signal outputted from the position feedback correction unit, positional control to output a velocity command; and
a velocity control unit for outputting a feedback torque command based on the velocity command outputted from the position control unit, and on the self-axis velocity.

### Claim 13 (depends on 12)

A servo controller according to claim 12, wherein, in the position feedback correction unit, the gain applied to the between-axes positional deviation is set at a negative value during operational stops, and is set at a positive value during operational runs.

### Claim 14 (depends on 13)

A servo controller according to claim 13, further comprising a velocity feedback correction unit for correcting a velocity feedback signal by adding a between-axes velocity deviation, filtered and gained, that is the difference between the self-axis velocity and the other-axis velocity, to the gained self-axis velocity;
wherein the velocity control unit outputs a feedback torque command based on the velocity command outputted from the position control unit, and on a corrected velocity feedback signal outputted from the velocity feedback correction unit.

### Claim 15 (depends on 12)

A servo controller according to claim 12, further comprising a velocity feedback correction unit for correcting a velocity feedback signal by adding a between-axes velocity deviation, filtered and gained, that is the difference between the self-axis velocity and the other-axis velocity, to the gained self-axis velocity;
wherein the velocity control unit outputs a feedback torque command based on the velocity command outputted from the position control unit, and on a corrected velocity feedback signal outputted from the velocity feedback correction unit.

### Claim 16

A servo controller comprising:
a position feedback correction unit for correcting a position feedback signal by adding a self-axis position filtered through a high-pass filter and an other-axis position filtered through a low-pass filter;
a position control unit for performing, according to a corrected position feedback signal outputted from the position feedback correction unit, positional control to output a velocity command; and
a velocity control unit for outputting a feedback torque command based on the velocity command outputted from the position control unit, and on the self-axis velocity.

### Claim 17 (depends on 16)

A servo controller according to claim 16, further comprising a velocity feedback correction unit for correcting a velocity feedback signal by adding a self-axis velocity filtered through a high-pass filter and an other-axis velocity filtered through a low-pass filter;
wherein the velocity control unit corrects the velocity feedback signal based on the velocity command outputted from the position control unit, and on a corrected velocity feedback signal outputted from the velocity feedback correction unit.

### Claim 18

A servo controller comprising:
a reference model control unit for calculating, based on a position command, a model position and a model acceleration for simulating an ideal movement for a machine;
a position control unit for performing, according to the difference between the model position and a self-axis position, positional control to output a velocity command;
a velocity control unit for outputting a feedback torque command based on the velocity command outputted from the position control unit, and on the self-axis velocity;
a model torque correction unit for correcting, according to the self-axis position and an other-axis position, the model acceleration to calculate a model torque; and
an accumulator for calculating a torque command based on the model torque and the feedback torque command.

### Claim 19 (depends on 18)

A servo controller according to claim 18, wherein:
the reference model control unit is further for calculating, based on the position command, a model velocity for simulating an ideal movement for the machine; and
the velocity control unit outputs the feedback torque command based on the velocity command outputted from the position control unit, on the model velocity, and on the self-axis velocity.

### Claim 20 (depends on 19)

A servo controller according to claim 19, wherein, in the model torque correction unit, in accordance with time or with a waveform of the velocity command, the correction unit's correction operation is started and stopped, or correction gains are changed.

### Claim 21 (depends on 20)

A servo controller according to claim 20, wherein, the model torque correction unit calculates the model torque by correcting the model acceleration further based on the sign of the model acceleration.

### Claim 22 (depends on 18)

A servo controller according to claim 18, wherein, in the model torque correction unit, in accordance with time or with a waveform of the velocity command, the correction unit's correction operation is started and stopped, or correction gains are changed.

### Claim 23 (depends on 22)

A servo controller according to claim 22, wherein, the model torque correction unit calculates the model torque by correcting the model acceleration further based on the sign of the model acceleration.

### Claim 24 (depends on 18)

A servo controller according to claim 18, wherein, the model torque correction unit calculates the model torque by correcting the model acceleration further based on the sign of the model acceleration.

### Claim 25

A servo controller comprising:
a reference model control unit for calculating, based on a position command, a model position and a model acceleration for simulating an ideal movement for a machine;
a position feedback correction unit for correcting a position feedback signal based on a self-axis position and an other-axis position;
a position control unit for performing, according to the difference between the model position and a corrected position feedback signal outputted from the position feedback correction unit, positional control to output a velocity command;
a velocity feedback correction unit for correcting a velocity feedback signal based on the self-axis velocity and the other axis-velocity;
a velocity control unit for outputting a feedback torque command based on the velocity command outputted from the position control unit, and on a corrected velocity feedback signal outputted from the velocity feedback correction unit;
a model torque correction unit for correcting, according to an other-axis model acceleration, to the self-axis position, and to the other-axis position, the model acceleration, to calculate a model torque; and
an accumulator for calculating a torque command based on the model torque and the feedback torque command.

### Claim 26 (depends on 25)

A servo controller according to claim 25, wherein:
the reference model control unit is further for calculating, based on the position command, a model velocity for simulating an ideal movement for the machine for simulating an ideal movement for the machine; and
the velocity control unit outputs the feedback torque command based on the velocity command outputted from the position control unit, on the model velocity, and on the corrected velocity feedback signal outputted from the velocity feedback correction unit.
