Servo control system

• US 5,252,902 A
• Filed: 03/01/1990
• Issued: 10/12/1993
• Est. Priority Date: 03/02/1990
• Status: Expired due to Fees

• Current Assignee: Kabushiki Kaisha SG
• Original Assignee: Kabushiki Kaisha SG
• Inventors: Uehara, Shinichiro, Takei, Manabu, Ichikawa, Wataru
• Primary Examiner(s): Shoop, Jr., William M.
• Assistant Examiner(s): MARTIN, DAVID S
• Application Number:
  US07/663,747
• Time in Patent Office: 1,321 Days
• Field of Search: 318/625, 318/34-35, 318/38-41, 318/111-113, 318/59, 318/560, 318/561, 318/567, 318/569, 318/590, 318/592-594, 318/599, 318/600-602, 318/675-677, 388/809-815, 388/933
• US Class Current: 318/599
• CPC Class Codes: G05B 19/4141 characterised by a controller or microprocessor per axis
• CPC Class Codes: G05B 2219/33155 Communication between motor current controller and position controller
• CPC Class Codes: G05B 2219/33187 Serial transmission rs232c, rs422, rs485 communication link
• CPC Class Codes: G05B 2219/34244 Multiplex for control only
• CPC Class Codes: G05B 2219/42062 Position and speed and current
• CPC Class Codes: G05B 2219/42237 Pwm pulse width modulation, pulse to position modulation ppm

Abstract

There are provided a position and velocity control system for producing a velocity command signal in response to a position command signal and a signal representing a current position and velocity of a servo motor, a current control system for supplying a drive current to the servo motor in response to the velocity command signal, and a communication system for transmitting data between the two systems by means of a bilateral communication line. A servo control system is thereby separated between the current control system and the position and velocity control system and connected to each other through the communication system. This separation through the communication system is advantageous for protecting the position and velocity control system from influence of noise generated in the current control system and also brings about benefits such as expansion of the controllability owing to the bilateral communication, sharing of a single current control system by plural servo motors by switching connection of the servo motors and controllability of plural pairs of servo motor and current control system by a single position and velocity control system by a multi-point connection.

Claims

1. A servo control system comprising:

a servo motor;

current control means responsive to a velocity command signal for supplying a drive current to said servo motor;

position and velocity control means, physically separated from said current control means, responsive to a position command signal and a signal representing a current position and velocity of said servo motor for supplying the velocity command signal to the current control means; and

communication means provided between said current control means and said position and velocity control means for transmitting data between said current control means and said position and velocity control means by means of a bidirectional data communication line, said communication means including a first bidirectional communication interface provided in said position and velocity control means and a second bidirectional communication interface provided in said current control means.

2. A servo control system as defined in claim 1 further comprising a high order controller which supplies the position command signal representing the target position of said servo motor to said position and velocity control means,

said high order controller transmitting data representing rated data of said servo motor to said current control means, and said current control means transmitting to said high order controller various data including a status signal representing a control state of said current control means, an ID code representing a current amplifier and a motor raded code representing rated data of a servo motor to be controlled.

3. A servo control system as defined in claim 2 wherein a plurality of said servo motors are provided and which further comprises switching means for selectively switching a servo motor to be driven by said current control means from among said servo motors in response to a switching signal from said high order controller.

4. A servo control system as defined in claim 1 wherein plural pairs of said servo motor and said current control means are provided and these plural pairs and said position and velocity control means are connected to each other by a multi-point connection by means of said communication means.

5. A servo control system as defined in claim 4 wherein said plural current control means are disposed adjacent to each other in a rack and heat radiation means is provided in common for each heat generating part of said current control means for radiating heat generated from said heat generating part to the outside.

6. A servo control system as defined in claim 1 wherein data transmission between said current control means and said position and velocity control means is made by using serial data composed of a start frame and a predetermined number of data frames added to the start frame in which each frame consists of

a start bit of one bit indicating start of a frame,

a data bit consisting of a predetermined number of bits provided next to the start bit,

a discriminating bit of one bit provided next to the data bit for discriminating the type of a next frame, and

a parity bit provided next to the discriminating bit,

said start frame is a frame in which at least one station address is set in said data bit and said data frame is a frame in which various data are set in the data bit.

7. A servo control system as defined in claim 6 wherein said current control means and said position and velocity control means comprise a serial communication interface for receiving and outputting the serial data consisting of the start frame and the data frame and extracting and outputting the data bit only from the received serial data.

8. A servo control system as defined in claim 7 wherein said serial communication interface comprises:

start bit detection means for detecting the start bit from among bits constituting said start frame and said data frame;

a first register connected to said start bit detection means for storing, in response to a detection signal provided by said start bit detection means, only said data bit, said discriminating bit and said parity bit among said serial data;

a second register connected to said first register for storing only the data bit stored in said first register;

timing signal generation means connected to said first and second registers for storing, in response to said discriminating bit stored in said first register, said data bit in a predetermined position of said second register; and

a first output buffer connected to said second register for delivering out said data bit.

9. A servo control system as defined claim 8 wherein said serial communication interface further comprises:

a third register connected between said second register and said output buffer for storing said data bit stored in said second register and forwarding it to said output buffer;

a fourth register connected to said third register for storing a data bit corresponding to a predetermined frame number among said data bit forwarded from said third register to said output buffer and shifting said stored data by a predetermined amount; and

a second buffer connected to said fourth register for supplying said data bit as a phase signal to said current control means.

10. A servo control system as defined in claim 7 wherein said serial communication interface further comprises a station select decoder connected to said first register for controlling, in response to a station address in said data bit stored in said first register, output of said data bit stored in said second register and transmission of said serial data.

11. A servo control system as defined in claim 1 in which said current control means is integrally incorporated in said servo motor.

12. A servo control system;

comprising;

a servo motor;

current control means responsive to a velocity command signal for supplying a drive current to said servo motor;

position and velocity control means, physically separated from said current control means, responsive to a position command signal and a signal representing a current position and velocity of said servo motor for supplying the velocity command signal to the current control means, comprising an absolute type and phase-shift type position sensor for detecting a current position and velocity of said servo motor including a coil winding section and a member which displaces relative to said coil winding section to change reluctance in said coil winding section in accordance with the relative position of said member with respect to said coil winding section, said coil winding section being excited by primary ac signals which are phase-shifted to one another to generate an output ac signal having an electrical phase difference corresponding to the absolute position of said servo motor; and

communication means provided between said current control means and said position and velocity control means for transmitting data between said current control means and said position and velocity means by means of a bidirectional data communication line.

13. A servo control system as defined in claim 12 wherein the output ac signal from said phase-shift type position sensor is directly fed back to said position and velocity control means without being transmitted through said communication line.