Position control device
AssigneeOkuma Corporation
InventorsTakeshi Sakai, Masashi Miyaji
Life of this patent
Estimating the term…
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.
Claims8
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.
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.
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.
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.
Dependencies are inferred from the claim text.