Tandem position control device

• US 9,639,078 B2
• Filed: 03/17/2016
• Issued: 05/02/2017
• Est. Priority Date: 03/19/2015
• Status: Active Grant

• Current Assignee: Okuma Corporation
• Original Assignee: Okuma Corporation
• Inventors: Eguchi, Satoshi
• Primary Examiner(s): Ro, Bentsu
• Assistant Examiner(s): AGARED, GABRIEL T
• Application Number:
  US15/072,865
• Publication Number:
  US 20160274563A1
• Time in Patent Office: 411 Days
• Field of Search: 318 34
• CPC Class Codes: 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
• CPC Class Codes: 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
• CPC Class Codes: G05B 2219/41426 Feedforward of torque
• CPC Class Codes: G05B 2219/42062 Position and speed and current
• CPC Class Codes: G05B 2219/49176 Compensation of vibration of machine base due to slide movement
• CPC Class Codes: H02P 5/747 mechanically coupled by gearing

Abstract

A position control device for driving one control target, using two drive shafts, has position control units provided to the respective drive shafts. Each position control unit includes a calculation unit for calculating a torque command value before compensation, a deflection vibration reduction torque compensator for calculating a deflection torque estimate and calculating a deflection vibration reduction torque compensation amount, based on the deflection torque estimate and a deflection vibration reduction compensation gain, and a compensator gain calculation unit for outputting, upon receipt of a tandem control command, to the deflection vibration reduction torque compensator, a signal for outputting the deflection vibration reduction torque compensation amount and calculating the deflection vibration reduction compensation gain, and the each of the position control units outputs a value obtained by adding the deflection vibration reduction torque compensation amount to the torque command value before compensation as the torque command value.

Claims

1. A position control device employing a tandem control method for driving one control target, using two drive shafts, comprising:

two position control units provided to the respective drive shafts, for each outputting a torque command value for a corresponding drive shaft,

wherein each of the position control units includes;

a calculation unit for calculating the torque command value before compensation, based on a position command value input from an upper-level device, and a detected position value of the corresponding drive shaft,

a deflection vibration reduction torque compensator for calculating a deflection torque estimate, based on the torque command value for the corresponding drive shaft and its own shaft velocity, or a velocity of the corresponding drive shaft, and calculating a deflection vibration reduction torque compensation amount to be added to the torque command value before compensation of the corresponding drive shaft, based on the deflection torque estimate and a deflection vibration reduction compensation gain, to output the deflection vibration reduction torque compensation amount, and

a compensator gain calculation unit for outputting, upon receipt of a tandem control command input from the upper-level device, to the deflection vibration reduction torque compensator, a switch signal for outputting the deflection vibration reduction torque compensation amount, calculating the deflection vibration reduction compensation gain, based on its own shaft velocity, a velocity of another shaft, and the deflection torque estimate, and outputting the deflection vibration reduction compensation gain calculated to the deflection vibration reduction torque compensator, and

each of the position control units outputs a value obtained by adding the deflection vibration reduction torque compensation amount to the torque command value before compensation as the torque command value.

2. The position control device according to claim 1, wherein the compensator gain calculation unit calculates the deflection vibration reduction compensation gain, based on a rigidity estimate of a target plant, calculated based on the deflection torque estimate, its own shaft velocity, and the velocity of the other shaft, an inertia moment identified in advance with respect to each shaft, and an attenuation coefficient set in advance.