Servo motor controlling method

• US 7,659,682 B2
• Filed: 03/23/2007
• Issued: 02/09/2010
• Est. Priority Date: 03/24/2006
• Status: Active Grant

• Current Assignee: Toshiba Kikai Kabushiki Kaisha (Toshiba Machine Company Limited)
• Original Assignee: Toshiba Kikai Kabushiki Kaisha (Toshiba Machine Company Limited)
• Inventors: Matsumoto, Ichiro, Hamamura, Minoru, Fujita, Jun
• Primary Examiner(s): Duda; Rina I
• Application Number:
  US11/690,189
• Publication Number:
  US 20080012520A1
• Time in Patent Office: 1,054 Days
• Field of Search: 318/625, 318/432, 318/632, 318/799, 318/823
• US Class Current: 318/625
• CPC Class Codes: G05B 19/41 characterised by interpolation, e.g. the computation of intermediate points between programmed end points to define the path to be followed and the rate of travel along that path G05B19/25, G05B19/31, G05B19/37, G05B19/39, G05B19/40 take precedence
• CPC Class Codes: H02P 23/06 Controlling the motor in four quadrants

Abstract

A servo motor controlling method includes: directly or indirectly detecting a position of a moving body which performs a circular-arc interpolation feeding motion by a servo motor; performing a feedback control for enabling the position of the moving body to comply with a position command; and at a quadrant changing time when a moving direction of the moving body is changed, performing torque correction on a torque command value according to a distance from a position where the moving direction is changed. By this method, a quadrant protrusion and a torque change with respect to a friction caused from a free zone at a time of reversion of a ball screw can be appropriately corrected. Especially, by performing a first torque correction for a static friction at the position where the moving direction is changed, and by performing a second torque correction for a moving friction after movement by the distance corresponding to the free zone, more appropriate correction can be obtained.

Claims

1. A servo motor controlling method comprising:

directly or indirectly detecting a position of a body moved by a servo motor;

controlling the servo motor via feedback based on the detected position of the body with position command to cause an arc interpolation motion; and

when a moving direction of the body changes as the arc interpolation motion changes from one quadrant to an adjacent quadrant, correcting a torque command value used to control the servo motor according to a distance between the position of the body after the chance in moving direction and a position at which the change in moving direction of the body occurred;

wherein when the body has a zone of movement substantially free of friction, the torque is not corrected when the position of the body after the change in moving direction is within the zone and the torque is corrected when the position of the body after the change in moving direction is outside the zone, and when the body is void of such zone, the torque is corrected according to the distance between the position of the body after the change in moving direction and the position at which the change in moving direction of the body occurred.

2. The servo motor controlling method according to claim 1, wherein the torque correction for a static friction is performed at the position at which the change in moving direction of the body occurred.

3. The servo motor controlling method according to claim 2, wherein the torque correction for the static friction is applied as a one-time pulse.

4. The servo motor controlling method according to claim 1, wherein:

the torque correction for a moving friction is performed when the position of the body after the change in moving direction is outside of the low-friction zone of movement, and

the torque correction amount for the moving friction decreases in time.

5. A servo motor controlling method comprising:

directly or indirectly detecting a position of a body moved by a servo motor;

controlling the servo motor via feedback based on the detected position of the body with a position command to cause an arc interpolation motion; and

when a moving direction of the body changes as the arc interpolation motion changes from one quadrant to an adjacent quadrant, correcting a torque command value used to control the servo motor;

wherein a first correction of the torque command value for a static friction is performed at a position at which the change in moving direction of the body occurred, and a second correction of the torque command value for a moving friction is performed when the position of the body after the change in moving direction is outside a zone of movement substantially free of friction.