Position control device

Patent metadata

Field	Value
Publication number	US-10008963-B2
Application number	US-201514686529-A
Country	US
Kind code	B2
Filing date	Apr 14, 2015
Priority date	Apr 14, 2014
Publication date	Jun 26, 2018
Grant date	Jun 26, 2018

Abstract

A compensation function constituting device calculates a correlation coefficient based on a moving distance required for reversing a moving direction of a movable unit and a sliding resistance acting on the movable unit, and a compensation amount output device calculates a moving distance on a position command value required until the movable unit starts to move according to the correlation coefficient and a feedback torque when the moving direction is reversed and increases a torque compensation amount in accordance with the moving distance after reversing the moving direction until the moving distance after the moving direction is reversed reaches the moving distance required until the movement is started.

First claim

What is claimed is:

1. A position control device for controlling a position of a movable unit by driving a servo motor in accordance with a position command value from a host device, comprising:
a velocity command output unit configured to output a velocity command value in accordance with at least the position command value;
a feedback torque output unit configured to output a feedback torque in accordance with a torque compensation amount and a value resulting from proportional integral amplification of a deviation between the velocity command value and a detected velocity value of the movable unit;
a feedforward torque output unit configured to output a feedforward torque in accordance with the position command value and inertia of the movable unit;
a torque command value output unit configured to output a torque command value in accordance with the feedback torque and the feedforward torque;
a motor drive unit configured to drive the servo motor in accordance with the torque command value;
a correlation information constituting device configured to calculate correlation information which is a value determined by dividing (i) a sliding resistance acting on the movable unit by, (ii) a moving distance on the position command value from a time when a moving direction reversing command is issued to the movable unit to a time when the movable unit inverts and starts to move; and
a compensation amount output device configured to calculate accordingly the torque compensation amount corresponding to the position command value based on the correlation information and the feedback torque when reversing a moving direction of the position command value.

2. A position control device for controlling a position of a movable unit by driving a servo motor in accordance with a position command value from a host device, comprising:
a velocity command output unit configured to output a velocity command value in accordance with at least the position command value;
a feedback torque output unit configured to output a feedback torque in accordance with a torque compensation amount and a value resulting from proportional integral amplification of a deviation between the velocity command value and a detected velocity value of the movable unit;
a feedforward torque output unit configured to output a feedforward torque in accordance with the position command value and inertia of the movable unit;
a torque command value output unit configured to output a torque command value in accordance with the feedback torque and the feedforward torque;
a motor drive unit configured to drive the servo motor in accordance with the torque command value;
a correlation information constituting device configured to calculate correlation information which is a value determined by multiplying (A) a value determined by dividing (i) a sliding resistance acting on the movable unit by (ii) a moving distance on the position command value from a time when a moving direction reversing command is issued to the movable unit to a time when the movable unit inverts and starts to move, by (B) a coefficient that varies with drive acceleration; and
a compensation amount output device configured to calculate accordingly the torque compensation amount corresponding to the position command value based on the correlation information and the feedback torque when reversing the moving direction of the position command value.

3. A position control device for controlling a position of a movable unit by driving a servo motor in accordance with a position command value from a host device, comprising:
a velocity command output unit configured to output a velocity command value in accordance with at least the position command value and a velocity compensation amount;
a feedback torque output unit configured to output, as a feedback torque, a deviation between the velocity command value and a detected velocity value of the movable unit after performing proportional integral amplification;
a feedforward torque output unit configured to output a feedforward torque in accordance with the position command value and inertia of the movable unit;
a torque command value output unit configured to output a torque command value in accordance with the feedback torque and the feedforward torque;
a motor drive unit configured to drive the servo motor in accordance with the torque command value;
a correlation information constituting device configured to calculate correlation information which is a value determined by dividing by: (i) a sliding resistance acting on the movable unit, by (ii) a moving distance on the position command value from a time when a moving direction reversing command is issued to the movable unit to a time when the movable unit inverts and starts to move;
a compensation amount output device configured to calculate accordingly a torque compensation amount corresponding to the position command value based on the correlation information and the feedback torque when reversing the moving direction of the position command value; and
a low frequency cutoff filter which has an inverse transfer characteristic of the feedback torque output unit and is configured to convert the torque compensation amount into the velocity compensation amount to output the velocity compensation amount.

4. A position control device for controlling a position of a movable unit by driving a servo motor in accordance with a position command value from a host device, comprising:
a velocity command output unit configured to output a velocity command value in accordance with at least the position command value and a velocity compensation amount;
a feedback torque output unit configured to output, as a feedback torque, a deviation between the velocity command value and a detected velocity value of the movable unit after performing proportional integral amplification;
a feedforward torque output unit configured to output a feedforward torque in accordance with the position command value and inertia of the movable unit;
a torque command value output unit configured to output a torque command value in accordance with the feedback torque and the feedforward torque;
a motor drive unit for driving the servo motor in accordance with the torque command value;
a correlation information constituting device configured to calculate correlation information which is a value determined by multiplying: (i) (A) a value determined by dividing a sliding resistance acting on the movable unit by (ii) a moving distance on the position command value from a time when a moving direction reversing command is issued to the movable unit to a time when the movable unit inverts and starts to move, by (B) a coefficient that varies with drive acceleration;
a compensation amount output device configured to calculate accordingly a torque compensation amount corresponding to the position command value based on the correlation information and the feedback torque when reversing the moving direction of the position command value; and
a low frequency cutoff filter which has an inverse transfer characteristic of the feedback torque output unit and is configured to convert the torque compensation amount into the velocity compensation amount to output the velocity compensation amount.

5. The position control device according to claim 1 , wherein:
the compensation amount output device is configured to calculate as a predicted moving distance, based on the correlation information and the feedback torque at the time of issuing the moving direction reversing command, the moving distance on the position command value from the time when the moving direction reversing command is issued to the movable unit to the time when the movable unit inverts and starts to move, and is further configured to output the torque compensation amount, which

Assignees

• Okuma Machinery Works Ltd

Inventors

• Sakai Takeshi
• Miyaji Masashi

Classifications

• H02P23/0004

  Control strategies in general, e.g. linear type, e.g. P, PI, PID, using robust control · CPC title

• G05B2219/25409

  Feedforward of control signal to compensate for delay in execution · CPC title

• G05B19/404 Primary

  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) · CPC title

• H02P1/028 Primary

  wherein the motor voltage is increased at low speed, to start or restart high inertia loads · CPC title

• G05B2219/41426

  Feedforward of torque · CPC title