Synchronous control device

• US 7,183,739 B2
• Filed: 03/03/2004
• Issued: 02/27/2007
• Est. Priority Date: 03/04/2003
• Status: Active Grant

• Current Assignee: Fanuc Ltd (Fanuc Corporation)
• Original Assignee: Fanuc Ltd (Fanuc Corporation)
• Inventors: Iwashita, Yasusuke, Kawamura, Hiroyuki, Tang, Zhiwei
• Primary Examiner(s): Donovan; Lincoln
• Assistant Examiner(s): SMITH, TYRONE W
• Application Number:
  US10/790,697
• Publication Number:
  US 20040180606A1
• Time in Patent Office: 1,091 Days
• Field of Search: 318560-632, 318/700, 318 66- 69, 318 77- 85, 318/98, 318/99, 318/52
• US Class Current: 318/625
• CPC Class Codes: G05B 2219/34027 Dual servo controller, for two motors
• CPC Class Codes: H02P 5/52 additionally providing control of relative angular displacement

Abstract

There is provided a synchronous control device for driving the same control object with two servomotors. The synchronous control device detects the physical quantity that represents the difference between the forces on the two servomotors, and, on the basis of the detected value, reduces the force that acts between the two servomotors.

Claims

1. A synchronous control device for controllably driving a servomotor, comprising:

a position control unit for outputting velocity commands at each predetermined cycle on the basis of the position deviation between position feedback from a position detector and position command transmitted at each predetermined sampling cycle from a host control device or a host control unit, and

a velocity control unit for outputting torque commands at each predetermined cycle on the basis of velocity feedback from velocity detectors and the velocity commands,

wherein said synchronous control device synchronously controls two servomotors for driving the same control object and further comprises means for reducing the force that acts between the two servomotors on the basis of the force that acts between the two servomotors,

and wherein the position control unit comprises;

a position deviation offset calculation processor for calculating the offset amount of the position deviation on the basis of the force that acts between the two servomotors, and

means for adding the position deviation offset amount calculated by the position deviation offset calculation processor to the position deviation,

and wherein the position deviation offset calculation processor computes the force that acts between the two servomotors from the difference in the torque commands given to the two servomotors, and calculates the position deviation offset amount by multiplying the computed difference by a conversion coefficient.

2. The synchronous control device according to claim 1, wherein the position deviation offset calculation processor calculates the offset amount of the position deviation when the difference between the forces on the two servomotors exceeds a fixed value.

3. The synchronous control device according to either of claims 1 or 2, wherein the position deviation offset calculation processor comprises adjusting means for changing the position deviation offset amount at a frequency that is sufficiently lower than the frequency band of the position control unit.

4. A synchronous control device for controllably driving a servomotor, comprising:

a position control unit for outputting velocity commands at each predetermined cycle on the basis of the position deviation between position feedback from a position detector and position command transmitted at each predetermined sampling cycle from a host control device or a host control unit, and

a velocity control unit for outputting torque commands at each predetermined cycle on the basis of velocity feedback from velocity detectors and the velocity commands,

wherein said synchronous control device synchronously controls two servomotors for driving the same control object and further comprises means for reducing the force that acts between the two servomotors on the basis of the force that acts between the two servomotors

and wherein the position control unit comprises;

a position deviation offset calculation processor for calculating the offset amount of the position deviation on the basis of the force that acts between the two servomotors, and

means for adding the position deviation offset amount calculated by the position deviation offset calculation processor to the position deviation,

and wherein the position deviation offset calculation processor computes the force that acts between the two servomotors from the actual electric currents that flow into the two servomotors, and calculates the position deviation offset amount by multiplying the computed difference by a conversion coefficient.

5. The synchronous control device according to claim 4, wherein the position deviation offset calculation processor calculates the offset amount of the position deviation when the difference between the forces on the two servomotors exceeds a fixed value.

6. The synchronous control device according to either of claims 4 or 5, wherein the position deviation offset calculation processor comprises adjusting means for changing the position deviation offset amount at a frequency that is sufficiently lower than the frequency band of the position control unit.