GB2404039A - Servomotor drive control system - Google Patents
Servomotor drive control system Download PDFInfo
- Publication number
- GB2404039A GB2404039A GB0421764A GB0421764A GB2404039A GB 2404039 A GB2404039 A GB 2404039A GB 0421764 A GB0421764 A GB 0421764A GB 0421764 A GB0421764 A GB 0421764A GB 2404039 A GB2404039 A GB 2404039A
- Authority
- GB
- United Kingdom
- Prior art keywords
- control unit
- drive control
- sensor
- data
- command
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/416—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by control of velocity, acceleration or deceleration
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/41—Servomotor, servo controller till figures
- G05B2219/41296—Two data lines; one for drive controllers, other to communicate with central unit
Landscapes
- Engineering & Computer Science (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Numerical Control (AREA)
Abstract
At least one drive control unit 12 controls the drive of at least one servomotor 100. A first communication line 1 transmits data such as a control command toward the drive control unit 12 from a command unit 10. A second communication line 2 transmits data such as detection data toward the command unit 10 from the drive control unit 12. At least one sensor control unit 14 receives detection data from one or more sensor 112-114 and transmits the data directly to the drive control unit 12 through one of the communication lines 1,2. The drive control unit 12 receives the control command from the command unit 10 and the detection data from the sensors 112-114 and controls the servomotor 100 on that basis.
Description
SERVOMOTOR DRIVE CONTROL SYSTEM
This invention relates to a servomotor drive control system for performing high-speed andhigh-accuracy synchronous operation between drive control units by optimized communications andinputting sensor information andperforming high-response and high-accuracy machine control.
FIG. q is a block diagram of a numerical control system in a related art, a kind of servomotor drive control system, for controlling drive control units by a numerical control unit of a command unit. Assuming that the numerical control unit is en upward unit end the drive controlunits are downwardunits, numerical control unit 10 and drive control units 12 and 13 are connected by a pair of communication lines made up of a downward communication line 1 and an upward communication line 2. An acceleration sensor 112 and limit switches 113 and 114 are attached to a controlled machine, and machine information of error information, sequence information, etc., is sent to the numerical control unit 10. The numerical control system configured as shown in FIG. synchronously operates the two drive control units 12 and 13 by one numerical control unit and acquires machine information by a sensor and performs sequence controland emergency control. Data transmitted from a transmission section 20 of the numerical control unit 10 is communicated over the downward communication line 1 and is received at reception sections 22 and 23 of the drive control units12and13. Overthedownwardcommunicationlinel,control commands of position, speed, electric current, etc., servo parameters required for the drive control units to perform control, andwarningandalarmsignalegiventothedrivecontrol units are communicated from the numerical control unit 10 to the drive control units 12 and 13. Data transmitted from transmission sections 42 and 43 of the drive control units 12 and 13 is communicated over the upward communication line 2 andisreceivedata reception section40Ofthenumericalcontrol unit 10. Over the upward communication line 2, detection data of the drive control units such es position, speed, end electric current, the current state of each of the drive control units, and data of warning and alarm signals, etc., are communicated from the drive control units 12 and 13 to the numerical control unitl0. The transmission data from the numerical control unit is transmitted in synchronization with the control period of the numerical control unit 10. The transmission timing of data from each of the drive control units 12 and 13 is kept in synchronization based on the data from the numerical control unit 10 and is scheduled based thereon, an example of which is shown in FIG. 10. In FIG. 10, numeral 1000 denotes communication period of the numerical control unit 10, numeral 1001 denotes data transmitted from the numerical control unit 10, and numeral 1003 denotes data transmitted from the drive control units 12 and 13.
The drive control unit 12 inputs a control command from the numerical control unit 10, detection data of an encoder 101 attached to a motor shaft end, and detection data ofa scale encoder 110 attached to the machine and performs servo control of aservomotor 100. The drive control unit 13 inputs a control command from the numerical control unit 10, detection data of an encoder 104 attached to a motor shaft end, and detection data of a scale encoder 111 attached to the machine end performs servo control of a servomotor 103. As the numerical control unit 10 synchronously operates the drive control units 12 and 13, the servomotors 100 and 103 drive ball screws 102 and 105 for moving a table 106 on which a workpiece 107 is placed, on the ball screws 102 and 105.
After detecting data of the acceleration sensor 112, the numerical control unit 10 transmits data to the downward communication line 1 and gives commands of position, speed, electric current, etc., to the drive control units 12 and 13 so as to prevent the machine from producing machine vibration and reduce overshoot at the machine position for improving the positioning accuracy.
When detecting some anomaly occurring in the system, the table 106 exceeding the moving range, and the limit switch 113, 119 being turned on, immediately the numerical control unit transmits emergency stop information to the drive control units 12 and 13 via the downward communication line 1 for stopping the drive control units 12 and 13 of the servomotors 102 and 103.
By the way, to synchronously operate two axes or more in the numerical control system, if the numerical control unit 10 gives a control command to each of the drive control units 12 and 13 in an open loop, when a disturbance is applied to one axis in synchronous operation, a large synchronization error appears. Thus, the numerical control unit 10 in the related art calculates a command in synchronization based on the detection data of position, speed, electric current, etc., transmitted from the drive control units 12 and 13 and then transmits the command to the drive control units 12 and 13, as described above.
However, if the numerical control unit 10 itself thus generates an error correction command, the preparation of the error correction command imposes a calculation load on the numerical control unit 10 and further the prepared command is a command delayed by one control period and for a disturbance like an impulse, a large synchronization error appears as a command is given in an open loop.
Thus,topreventadisturbancelikeanimpulsefromcausing a synchronization error to occur, es shown in FIG. 11, the drive controlunit12isprovidedwithareceptionsection51connected to the upwardcommunicationline2 end receives et the reception section 51 the detection data of position, speed, electric current, etc., of the drive control unit 13 transmitted in accordance with the control period of the numerical control unit 10 and compares the received detection data with the detection data of the drive control unit 12, thereby correcting the synchronization error before the next control period of the numerical control unit 10. The system shown in FIG. ll is disclosed in JP-A-934520/US--5 bug 465.
However, if the drive control unit 12 corrects the synchronization error as described above, the date of the drive control units 12 and 13 is transmitted in accordance with the control period of the numerical control unit 10 and therefore the period in which the drive control unit 12 can correct the synchronization error depends on the control period of the numericalcontrolunitlOandthus thereisalimitto correcting of the synchronization error with good accuracy by the drive control unit 12. To improve the control performance of the drive control unit, itis possible to shorten the controlperiod ofthenumericalcontrolunit;however, to provide the numerical control unit with high performance, complicated coordinate computation and control processing need to be performed for a larger number of control axes and it is not easy to shorten the control period.
For the drive control unit to perform control based on a plurality of pieces of sensor information, the drive control unit requires alarge number of connectors, etc., for receiving detection data, but it is substantially impossible to provide the drive control unit with connectors, etc., for receiving detection data corresponding to sensors. Therefore, the numerical control unit 10 in place of the drive control unit inputs the detection data of the acceleration sensor 112 and generates a commend. Thus,thecommandisdelayedbyonecontrol period as in the synchronous operation described above and if machine information is acquired by the sensor, the control performance is not much improved and there is a problem of increasing the calculation load on the numerical control unit 10.
To conduct emergency stop of the systembythelimit switch 113, 114 for safety, the information of the limit switch 113, 114 is once processed by the numerical control unit 10 and is transmitted as data. Thus, the idle time is large and the coasting distance after the emergency stop is extended.
The invention is intended for solving the problems described above and it is an object of the invention to provide a servomotor drive control system that can correct a synchronization error accurately if the synchronization error is corrected in drive control units.
It is another object of the invention to provide a servomotor drive control system for making it possible to decrease calculation loads on a command unit of a numerical control unit, etc., and drive control units, moreover for drive control units having the same control performance, to increase the number of axes to which synchronization error correction can tee mace using one type of drive control unit, end by extension to easily make the system highly accurate.
It is another object of the invention to provide a servomotor drive control system for making it possible to decrease calculation loads on a command unit of a numerical control unit, etc., and drive control units and moreover to perform high-speed and high-accuracy synchronous operation.
It is still another object of the invention to provide a servomotor drive control system for making it possible for drive control units to detect a plurality of pieces of sensor information without increasing the number of connectors for detector data reception and not via a command unit of a numerical control unit, etc., and by extension to make the system a highspeed and high-accuracy system.
The present invention provides a servomotor drive control system comprising: a command unit; one or more drive control units for controlling drive of one or more servomotors; a first communication line for transmitting data such as a control command, in a direction of the drive control unit(s) from the command unit; a second communication line for transmitting data such as detection data, in a direction of the command unit from the drive control unit(s); and one or more sensor control units for inputting detection data of one or more sensor(s) and transmitting the data directly to the drive control unit(s) through the first or second communication line; the drive control unit(s) receiving the control command from the command unit transmitted through the first communication line and the detection data of the sensor(s) transmitted through the first or second communication line, and controlling the servomotor(s) based on the received control command and detection data of the sensor(s).
Preferably, in the above-mentioned servomotor drive pOv control system, the communication period of periodic communication between the abovementioned drive control unit and the above-mentioned sensor control unit is set to one-nth of the communication repetition period of the abovementioned command unit (n being an integer).
In the accompanying drawings: FIG 1 is a diagram to show the configuration of a numerical control system according to a first embodiment of the invention.
FIG. 2 is a diagram to show the configuration of a sensor control unit of the numerical control system according to the first embodiment.
FIG. 3 is a control flow diagram of the numerical control system according to the first embodiment.
FIG. 4 is a diagram to show the configuration of a numerical control system according to a second embodiment of the invention.
FIG. 5 is a control flow diagram of the numerical control system according to the second embodiment.
FIG. 6 is a control flow diagram of a numerical control system according to a third embodiment of the invention.
FIG. 7 is a diagram to show the configuration of a numerical control system according to a fourth embodiment of the invention.
FIG. 8 is a control flow diagram of the numerical control system according to the fourth embodiment.
FIG. 9 is a diagram to show the configuration of a numerical control system in a related art.
FIG. 10 is a control flow diagram of the numerical control system in the related art.
FIG. 11 is a diagram to show the configuration of a numerical control system in another related art.
F1rst embodiment.
FIG.?isadiagramtoshowtheconfigurationofanumerical control system, a kind ofservomotor drive control system, with one numerical control unit, one drive control unit, and one sensorcontrolunitforfeedingbackdetectiondataofthesensor control unit and performing motor control. FIG. 2 is a diagram to show the configuration of the sensor control unit. FIG. sisacontrolflow chars of the numericalcontrolsystem (timing chart of transmission and reception data).
In FIG. 1, numeral 10 denotes a numerical control unit of a command unit having a transmission section 20 connected to a downward communication line 1 (first communication line) end a reception section 40 connected to an upward communication line2 (secondcommunication line). Numeral 12 denotes a drive control unit having a reception section 22 and a transmission section 31 connected to the downward communication line l and a transmission section 42 and a reception section 51 connected to the upwardcommunication line2. Numeral14 denotes a sensor controlunit for controlling apluralityof sensors andmanaging transfer of date over the communicationlinesland2, the sensor control unit 14 having a reception section 24 connected to the downward communication line 1 and a transmission section 44 connected to the upward communication line 2.
The sensor control unit 14 is configured as shown in FIG. 2. That is, the sensor control unit 14 acquires detection data of sensors 120 and 121 by serial communications using transmission sections 140 and 142 and reception sections 141 and143, acquires defection data ofsensors122 and123byanalog input with an A/D converter 131, acquires detection data of sensors124and125withgeneral-purposeI/Oinput132, converts the detection data and the status of each sensor into an outputable data format to the communication line 2 by a control circuit 130, and upward transmits the provided data by the transmission section 44. That is, the sensor control unit 14 is configured so that it can input data detected by any type of sensor. The control circuit 130 receives data over the downward communication line at the reception section 24, executes an initialization command such as a communication timing setting command transmitted through the transmission section 20 and the communication line 1 from the numerical controlunitlO, end executes a commend such es offset correction to the sensor transmitted through the transmission section 31 and the communication line 1 from the drive control unit 12.
Numeral 100 denotes a servomotor controlled by the drive control unit 12 and numeral 101 denotes an encoder attached to a shaft end of the servomotor 100 Output of the-encoder is input to the drive control unit 12. Numeral 102 denotes aballscrew drivenbytheservomotorlOOandnumerallO6denotes a table of a machine tool, etc., moved as the ball screw 102 is driven.
Numeral 110 denotes a scale encoder attached to a machine and output of the encoder is input to the drive control unit 12. Numeral 112 denotes an acceleration sensor for detecting the acceleration of the table 106 and output of the sensor is input to the sensor control unit 14. The detection data of the acceleration sensor 112 is input through the reception section 141 of the sensor control unit 14 in FIG.2. Numerals 113andll4denotelimitswitchesattachedtoendsofthemachine; when the table 106 exceeds the moving range for some reason, the limit switch is turned on. Output of the limit switch is input to the sensor control unit 14. The detection data of the limit switch 113, 114 is input through the general-purpose I/O 132 of the sensor control unit 14 in FIG. 2.
The numerical control system according to the first embodiment is configured as described above and operates as follows: The numerical control unit 10 uses the transmission section 20 to transmit a control command 1001 to the downward communication line 1 every communication period 1000 of the numerical control unit, as shown in FIG. 3. The drive control unit 12 inputs the control command 1001 transmitted from the numerical controlunitlO and received et the reception section 22, the detection data of the encoder 101 attached to the motor shaft end, and the detection data of the scale encoder 110 attached to the machine end and performs servo control of the servomotor 100. The servomotor 100 drives the ball screw 102 for moving the table 106 on the ball screw 102 as commanded.
At this time, the sensor control unit 14 is controlled based on data 1001 and 1007 transmitted from the numerical control unitlOandthedrivecontrolunit12andreceivedatthereception section 24, inputs acceleration data 1004 of the table 106 from the acceleration sensor 112, and transmits the data from the transmission section 44 to the upward communication line 2 in synchronizationwiththecontrolperiodofthenumericalcontrol unit 10 (C) in FIG. 3). The drive control.unit 12 receives the acceleration data1004 transmitted to the upward communication line2 directly at the reception sectional not vie the numerical control unit 10 (by in FIG. 3) and reflects the acceleration data 1004 on control of the servomotor 100. That is, the acceleration data is integrated to the speed at the machine end and the difference between the motor speed the speed at the machine end is fed beck for compensation, therebyimproving responsivity.
At the control time, if the table 106 exceeds the moving range for some reason and the limit switch 113 or 114 is turned on, the sensor control unit 14 inputs an on signal 1004 and transmits the signal from the transmission section 44 to the upward communicationline2 insynchronizationwith the control periodlOOOofthenumericalcontrolunitlO. The drive control unit 12 receives the on signal 1004 of the limit switch 113 or 114 transmitted to the upward communication line 2 directly at the reception section 51 not via the numerical control unit and stops the servomotor 100.
The drive control unit 12 transmits diagnosis data of the current state, a warning, an alarm, etc., and detection data 1003 of position, speed, electric current, etc., detected whentheservomotorlOOiscontrolledtotheupwardcommunication line2by the transmission section42everycommunicationperiod 1000 of the numerical control unit 10.
The transmission timings of the data 1003 transmitted from the drive control unit 12 to the upward communication line 2 and the data 1004 transmitted from the sensor control unit 14 to the upward communication line 2 are scheduled so that the data 1003 and the data 1004 do not collide with each other within the communication period 1000 defined by the numerical control unit 10 as shown in FIG. 3, and the data 1003 and the data 1004 can be transmitted to the upward communication line 2 without colliding with each other, so that the drive control unit 12 can receive the data 1004 from the sensor control unit 14 and the numerical control unit 10 can also receive the data 1003 from the drive control unit 12 and the data 1004 from the sensorcontrolunitl4atthereceptionsection40andcanmonitor the data.
As described above, according to the fourth embodiment, the detection data of the acceleration sensor 112 can be reflected on the servo controlwithinonecommunicationperiod, machine vibration can be suppressed, and the positioning accuracy can be improved. Since the drive control unit 12 can directly input the detection data of the limit switch 113, 114 not via the numerical control unit 10, it is made possible to stop the system without any delay caused by the intervention of any other unit at the emergency time at which the table 106 exceeds the moving range, for example.
The need for providing the drive control unit 12 with dedicated connectors and circuits for receiving the data of the acceleration sensor 112 and the limit switches 113 and 114 is eliminated and by extension a general-purpose unit can be used as the drive control unit.
Also in the embodiment, if the communication period of each of the drive control unit 12 and the sensor control unit 14 is set to one-nth of the communication period 1000 of the numerical control unit 10 (n is an integer), it is made possible for the drive control unit 12 to input the detection data of the sensors independently of the communication period 1000 of the numerical control unit 10 and by extension the positioning accuracy can be furthermore improved and it is made possible to stop the system more rapidly at the emergency time.
In the embodiment, the numerical control system for controlling one motor by one drive control unit has been described. However, if the two motors for driving the table 106 are controlled by the drive control units and only one acceleration sensor 112 for detecting the acceleration of the table 106 is attached to the table 106 (only one detection data of the acceleration sensor exists) as described in the first embodiment, thesecondembodiment,etc., thedrivecontrolunits can receive the defection date of the acceleration sensor almost at the same time via the sensor control unit 14 and the upward communication line 2. Thus, in the configuration as described above, providing the sensor control unit 14 is furthermore effective for suppressing machine vibration and improving the positioningaccuracy. Inthisconnection,intheconfiguration asdescribedabove, ifthesensorcontrolunit14isnotprovided, the detection data of the acceleration sensor needs to be sent via one drive control unit to the other and thus each drive control unit receives the detection data of the acceleration sensor with a delay and by extension the effect of feedback compensationusingthedetectiondataoftheaccelerationsensor is weakened.
In the first embodiment, the numerical control system wherein the sensor control unit 14 is connected downward from the drive control unit 12 and the detection data is transmitted to the drive control unit 12 through the communication line 2 has been described. However, if the sensor control unit 14 isconnectedupwardfromthedrivecontrolunit12,thedetection data is transmitted to the drive control unit 12 through the communication line 1, needless to say.
Se"d embodiment.
Next as. embodiment oftheinventionwillbe discussed with FIGS. 2, 4, and 9.
FIG. 4 is adiagramto show the configurationofa numerical control system, a kind ofservomotor drive control system, with one numerical control unit, onemotion control unit, one sensor control unit, and two drive control units for feeding back detection data of the sensor control unit and performing synchronous operation. FIG. 5 is a control flow chart of the numerical control system (timing chart of transmission and reception data) .
In FIG. 4, numeral 10 denotes a numerical control unit of a command unit having a transmission section 20 connected to a downward communication line 1 (first communication line) and a reception section 40 connected to an upward communication line2 (secondcommunicationline). Numerallldenotesamotion control unit for calculating a synchronization error between two axes and generating a synchronization error correction controlcommand,themotioncontrolunitllhavingatransmission section 30 and a reception section 21 connected to the downward communication line 1 and a transmission section 41 and a reception section 50 connected to the upward communication line 2. The numerical control unit 10 and the motion control unit 11 have their respective calculation CPUs. Numeral 12 denotes a master drive control unit having a reception section 22 connected to the downward communication line 1 and a transmission section 42 and a reception section 51 connected to the upward communication line 2. Numeral 13 denotes a slave drive control unit for synchronously operating with the drive control unit 12, the drive control unit 13 having a reception section 23 connected to the downward communication line 1 and a transmission section 43 and a reception section 52 connected to the upward communication line 2. Numeral 14 denotes a sensor control unit similar to the sensor unit described in detail with FIG. 2 in the fourth embodiment for controlling a plurality of sensors and managing transfer of data over the communication lines 1 and 2, the sensor control unit 14 having a reception section 24 connected to the downward communication line 1 and a transmission section 44 connected to the upward communication line 2. Numeral 100 denotes a servomotor controlled by the drive control unit 12 andnumeral 101 denotes an encoder attached to a shaft end of the servomotor 100. Output of the encoder is input to the drive control unit 12. Numeral 102 denotes a ball screw driven by the servomotor 100, numeral 103 denotes is aservomotorcontrolledbythedrivecontrolunit13,andnumeral 104 denotes an encoder attached to a shaft end of the servomotor 103. Output of the encoder is input to the drive control unit 13. Numeral 105 denotes a ball screw driven by the servomotor 103 and numeral 106 denotes a table of a machine tool, etc., moved as the ball screws 102 and 105 are driven. Numeral 110 denotes a scale encoder attached to a machine and output of the encoder is input to the drive control unit 12. Numeral 111 denotes a scale encoder attached to the machine and output of the encoder is input to the drive control unit 13. Numeral 112 denotes an acceleration sensor for detecting the acceleration of the table 106 and output of the sensor is input to the sensor control unit 14. Numerals 113 and 114 denote limit switches attached to ends of the machine; when the table 106 exceeds the moving range for some reason, the limit switch is turned on and output of the switch is input to the sensor control unit 14.
The numerical control system according to the Regard embodiment is configured as described above and operates as follows: The numerical control unit 10 uses the transmission section 20 to transmit a control command 1001 to the downward communication line 1 every communication period 1000 of the numerical control unit, as shown in FIG. 5. The drive control unit 12 inputs the control command 1001 transmitted from the it numerical controlunitlO end received et the reception section 22, the detection data of the encoder 101 attached to the motor shaft end, and the detection data of the scale encoder 110 attached to the machine end and performs servo control of the servomotor 100. The drive control unit 13 inputs the control command 1001 transmitted from the numerical control unit 10 and received at the reception section 23, the detection data of the encoder 104 attached to the motor shaft end, and the detection data of the scale encoder 111 attached to the machine end and performs servo control of the servomotor 103. The servomotors 100 and 103 drive the ball screws 102 and 105 for movingthetable106on the ballscrews102and105as commanded.
The drive control unit 12, 13 transmits diagnosis data of the current state, a warning, an alarm, etc., and detection IS data 1003 of position, speed, electric current, etc., detected when the servomotor 100, 103 is controlled to the upward communication line 2 by the transmission section 42, 43 every communication period of the numerical control unit 10 (id in FIG. 5). Atthistime, the sensor controlunit14is controlled based on data 1001 transmitted from the numerical control unit lOandreceivedatthereceptionsection24, inputs acceleration data 1004 of the table 106 from the acceleration sensor 112, and transmits the data from the transmission section 44 to the upwardcommunicationline2 in synchronization with the control period of the numerical control unit 10 (it in FIG. 5). The data transmitted from the drive control unit 12, 13 and the data transmitted from the sensor control unit 14 are scheduled so that they do not collide with each other within the communication periodlOOOdefinedbythenumericalcontrolunit 10 as shown in FIG. 5, and they are transmitted to the upward communication line 2 without colliding with each other. In FIG. 5', numeral1002denotesasynchronizationerrorcorrection control command prepared by the motion control unit 11 and transmitted to the drive control unit 12, 13 through the transmission section 30 and thedownward communication line 1, and numeral 1003B denotes data of the synchronization error correction amount, the status of the motion control unit 11, etc., transmitted by the motion control unitll to the numerical control unit 10 through the transmission section 41 and the upward communication line 2.
The motion control unit 11 receives the control command 1001 transmitted from the transmission section20OfthenumericalcontrolunitlO through the downward communication line 1 at the reception section 21, andreceivesthedetectiondatalO03Ofposition,speed,electric current, etc., transmitted from the transmission sections 42 and 43 of the drive control units 12 and 13 through the upward communication line 2 at the reception section 50.
Since the data transmitted from the drive control units 12 and 13 is scheduled as described above, the motion control unit 11 can receive all the detection data 1003 of the drive control units 12 and 13 like the numerical control unit 10.
Based on the described reception data, the motion control unit 11 detects a lag from the control command of the two drive control units 12 and 13 performing synchronous control and a synchronization error between axes, generates a synchronization error correction control command 1002, and transmits the data from the transmission section 30 over the downward communication line 1 to the drive control unit 13 (it in FIG. 5).
Atthetime,thesynchronizationerrorcorrectioncontrol command from the motion control unit 11 is scheduled as shown in FIG. 5 and is transmitted over the downward communication line 1 without colliding with the control command 1001 from the numerical control unit 10. The drive control unit 13 receives the synchronization error correction control command 1002transmittedfromthemotioncontrolunitllatthereception section 23 (it in FIG. ) and corrects the synchronization error.
ThesynchronizationerrorcorrectioncontrolcommandlO02 generated by the motion control unit 11 is assigned the address corresponding to the address of the drive control unit 13 for transmission and thus is not received by the drive control unit 12 and can be received only by the drive control unit 13.
Correction processing (correction calculation, output processing of the calculation result to servomotor) based on the synchronization error correction control command 1002 received by the drive control unit 13 is executed while transmission/reception processing is not performed. The motion control unit 11 generates the synchronization error correction control command 1002 between reception processing and transmission processing although not shown.
Since the correction processing capability of the drive control unit 13 is already known, when the drive control unit 13 performs correction calculation, if it is determined that the calculation processing is not complete by the time another command comes from the numerical control unit 10, the drive control unit 13 performs correction only in the correction processing amount that can be completed by the time another command comes from the numerical control unit 10, and discards the remaining correction processing amount.
The motion control unit 11 transmits the data 1003B of the synchronization error correction amount, the status of the motion control unit 11, etc., from the transmission section 41 to the upward communication line 2. The numerical control unit 10 receives the data at the reception section 40 together with the data 1003 and 1004 transmitted from the drive control unit 12, 13 and the sensor control unit 14, monitors the data, and performs alarm processing for the drive control unit 12, 13, the sensor control unit 14, etc., as required.
The drive control unit 12, 13 receives the acceleration data 1004 transmitted from the sensor control unit 14 to the upward communication line 2 directly at the reception section 51 not via the numerical control unit 10 or the motion control unit 11 (it in FIG. 5) and reflects the acceleration data 1004 oncontroloftheservomotorlOO,103. Thatis,theacceleration data is integrated to the speed at the machine end and the difference between the motor speed the speed at the machine end is fed back for compensation, thereby improving responsivity.
At the control time, if the table 106 exceeds the moving range for some reason and the limit switch 113 or 114 is turned on, the sensor control unit 14 inputs en on signal and transmits the signal from the transmission section 44 to the upward communicationline2in synchronizationwith the controlperiod 1001 of the numerical controlunitlO (it in FIG. 5). The drive control unit 12, 13 receives the on signal 1004 of the limit switch 113 or 114 transmitted to the upward communication line 2 directly at the reception section 51, 52 not via the numerical control unit 10 (if in FIG. 6) and stops the servomotor 100, 103-.
As described above, according to the second embodiment, the motion control unit 11 generates the synchronization error correction control command, whereby the calculation load on the numerical controlunit 10 for preparing the synchronization error or the control processing load on the drive control unit 12 for correcting the synchronization error can be reduced.
For example, if the drive control unit 12 corrects the synchronization error as in the related art, in addition to the usual control calculation, the calculation load for correcting the synchroni zation error occurs on the drive control unit 12 and itmaybecome impossible to complete synchronization error handling within one control period. However, according to the secooL embodiment, such a disadvantage is eliminated.
To increase the number of axes that can be controlled, a drive control unit having the same configuration as the drive control unit 12, 13 is added with the numerical control unit and the drive control units 12 and 13 intact, whereby the number of axes to which synchronization error correction can be made can be increased and by extension it is easily made possible to make the system highly accurate.
The detection data of the acceleration sensor 112 can be reflectedon the servo controlwithinone communicationperiod, machine vibration can be suppressed, and the positioning accuracy can be improved. At this time, the drive control units 12 and 13 can receive the detection data of the acceleration sensor 112 almost at the same time via the sensor control unit 14 and the upward communication line 2, so that the suppression effect of the machine vibration and the positioning accuracy are not degraded. In this connection, if the sensor control unit 14 is not provided, the detection data ofthe acceleration sensor 112 needs to be sent via one drive control unit 13 to the other drive control unit 12 and thus each drive control unit 12, 13 receives the detection data of the acceleration sensor 112 with a delay and by extension the effect of feedback compensationusingthedetectiondataoftheaccelerationsensor 112 is weakened.
Since the drive control unit 12 can directly input the detection data ofthelimitswitch113, 114notviathenumerical control unit 10, it is made possible to stop the system without any delay caused by the intervention of any other unit at the emergency time at which the table 106 exceeds the moving range,
for example.
Further, the need for providing the drive control unit 12, 13 with dedicated connectors for receiving the data of the acceleration sensor 112 and the limit switches 113 and 114 is eliminated and by extension a general-purpose unit can be used as the drive control unit.
In the Become embodiment, the data of the scale encoders llOandlllisinputtothedrivecontrolunits12and13. However, after the data is input to the sensor unit 14, the data may be sent from the transmission section 44 to the upward communication line 2 corresponding to the control period of the numerical control unit 10 and may be received by the drive control units 12 and 13 through the reception sections 51 and 52. In doing so, the need for providing the drive control units 12 and 13 with dedicated connectors to the scale encoders 110 and 111 is eliminated.
Intheembodimentdescribedabove,offsetcorrectiondata of the sensor unit 14 may be transmitted from the numerical control unit 10 or the motion control unit 11.
In the Recomb embodiment, the drive control unit 12 is the master and the drive control unit 13 is the slave, namely, if the drive control unit 12 of the master makes correction, whet the controlreferenceisbecomesindistinct end the control becomes complicated and thus the drive control unit 13 of the slave makes synchronization error correction. However, only the drive controlunitl2Of the master maymake synchronization error correction.
The synchronization error correction can also be shared between the drive control unit 12 and the drive control unit 13.
In the ooL embodiment, the numerical control system wherein the sensor control unit 14 is connected downward from the drive control units 12 and 13 and the detection data is transmitted to the drive control units 12 and 13 through the communicationline2hasbeendescribed. However, if the sensor controlunit14 is connected upward from the drive control units 12and13, the defection datais transmitted Lo the drive control units 12 and 13 through the communication line 1, needless to say.
HI Bird embodiment.
Next,a third embodimentoftheinventionwillbediscussed with FIGS. 4 and 6.
In the hard embodiment, a numerical control system for performing synchronous operation in a similar configuration to that of these embodiment shownin FIG. *, a communication period 1006 of each of a motion control unit 11, drive control units 12 and 13, and a sensor control unit 14 is set to one-nth of a communication period 1000 of a numerical control unit 10 (nisaninteger;intheembodiment,n=2)asthedatatransmission and reception timings of the units are shown in FIG. 6.
In the Shied embodiment, the contents of the data transmitted and received by the numerical control unit 10, the motion control unit 11, the drive control units 12 and 13, and the sensor control unit 14 are similar to those in the Scoop.
embodiment.
Thus, the numerical control unit 10 transmits data in thecommunicationperiodlOOOdefinedbasedonthecontrolperiod of the numerical control unit 10 and each of the motion control unitll, the drivecontrolunits12and13, end the sensor control unit14 transmits and receives data in the communication period 1006Ofone half the communication period 1000 of the numerical control unit 10. Thus, while the numerical control unit 10 transmits one control command, the motion control unit 11 can receive twice detection data 1003 of the drive control unit 12, 13 transmitted through an upward communication line 2 and can transmit twice a synchronization error correction control command 1002 to the drive control unit 12, 13.
Likewise, during one communication period of the numerical control unit 10, the drive control unit 12, 13 can receive twice the synchronization error correction control command 1002 and can transmit twice the detection data 1003 through the upward communication line 2 and can receive twice sensor detection data 1004 from the sensor control unit 14.
Further, while the numerical control unit 10 transmits one control command 1001, the sensor control unit 14 can also transmit twice the sensor detection data 1004 to the drive control unit 12, 13.
As described above, according to thehrd embodiment, the motion control unit 11 generates the synchronization error correction control command, whereby the calculation load on the numerical controlunitlO for preparing the synchronization error or the control processing load on the drive control unit 12 for correcting the synchronization error can be reduced.
To increase the number of axes that can be controlled, a drive control unit having the same configuration as the drive control unit 12, 13 is added with the numerical control unit 10 and the drive control units 12 and 13 intact, whereby the number of axes to which synchronization error correction can be made can be increased and by extension it is easily made possible to make the system highly accurate.
Since the sensor information such as the detection data of the acceleration sensor 112 can be acquired independently of the control period of the numerical control unit 10, the suppression frequency of machine resonance can be raised and highly responsive machine positioning is made possible.
Since the drive control unit 12, 13 can directly input the detection data of the limit switch 113, 114 not via the numericalcontrolunitlOandmoreover can acquire the defection data independentlyofthe controlperiodofthenumerical control unit 10, it is made possible to stop the system without any delay caused by the intervention of any other unit at the emergency time at which the table 106 exceeds the moving range,
for example.
The need for providing the drive control unit 12, 13 with dedicated connectors for receiving the date of the acceleration sensor 112 and the limit switches 113 and 114 is eliminated and by extension a generalpurpose unit can be used as the drive control unit.
Further, the synchronization error correction control command 1002 transmitted by the motion control unit 11 is not bound by the control period of the numerical control unit 10 and it is made possible to suppress the synchronization error - amount caused by a disturbance like an impulse in a short time.
In the third embodiment, the communication period 1006 of each of the motion control unit 11, the drive control units 12 and 13, and the sensor control unit 14 is set to one half the communication period 1000 of the numerical control unit 10. If the communication period is furthermore shortened, for example, to one-third or one-fourth, it is made possible to suppress the synchronization error amount caused by a disturbance like an impulse in a shorter time.
F=v th embodiment.
Next a (or th embodiment of the invention will be discussed with FIGS. 7 and 8.
FIG. 7 is a diagram to show the configuration of a numerical control system, a kind of servomotor drive control system, with one numerical control unit, one motion control unit, one sensor control unit, and two drive control units for feeding back detection data of the sensor control unit and performing synchronous operation. FIG. g is a control flow chart of the numerical control system (timing chart of transmission and reception data).
Inthe-orth embodiment, as shown in FIG. 7, the motion control unit 11 is provided with internal contacts 64 and 65 for separating in the motion control unit 11 the downward and upward communication lines 1 and2 for connecting the numerical control unit 10 having a long communication period, the motion control unit 11, the drive control units 12 and 13, and the sensor control unit 14 described in the second embodiment (FIG.
4), whereby the drive control units 12 and 13 and the sensor control unit 14 each having a short communication period are separated from the numerical control unit 10 having a long communication period. The contacts 69 and 65 are open at the normal operation time and are closed only at the initialization time before the normal operation.
To intervene in data transfer between the numerical control unit 10 having a long communication period and the drive control units 12 and 13 and the sensor control unit 14 each having a short communication period as the units are separated, the reception section 21 of the motion control unit 11 is connected to a downward communication line 60 connected to the transmission section 20 of the numerical control unit 10 and the transmission section 41 is connected to an upward communication line 62 connected to the reception section of the numerical control unit 10 and the transmission section 30 of the motion control unit 11 is connected to a downward communication line 61 connected to the reception sections 22, 23, and 24 of the drive control units 12 and 13 and the sensor control unit 14 and further the transmission section 50 is connected to an upward communication line 63 connected to the transmission sections 42, 43, and 44 of the drive control units 12 and 13 and the sensor control unit 19. That is, the motion control unit 11 is connected to other units in a daisy chain way.
Further, the communication period between the motion control unit 11 and the drive control units 12 and 13 and the sensor control unit 14 is set to one-nth of the communication period between the numerical control unit 10 and the motion control unit 11 (n is an integer; in the embodiment, n=2).
Other components are similar to those of the second embodiment.
The numerical control system according to the moth embodiment is configured as described above and operates as follows: As shown in FIG. , with the contacts 64 and 65 open, the numerical control unit 10 transmits a control command 1001 of the motion 11 control unit and a control command 1001 of position,speed,electriccurrent, etc., for two controlperiods in the drive control unit 12, 13 from the transmission section to the downward communication line 60 in accordance with the control period 1000 of the numerical control unit.
The motion control unit 11 receives the control command 1001 by the reception section 21, divides the command from the numerical control unit 10 to the drive control unit 12, 13 into two pieces so as to match the control period 1006 of the drive controlunit 12, 13 (A in FIG. ) , againprepares, end transmits from the transmission section 30 to the downward communication line 61.
Atthistime,themotioncontrolunitllreceivesdetection data 1003 of position, speed, electric current, etc., from the drive control unit 12, 13, transmitted to the upward communication line 63 at the reception section 50, detects a lag from the control command of the two drive control units 12 and13 performing synchronous control and a synchronization error between axes, generates a synchronization error correction control command, and transmits the data together with the control command from the numerical control unit 10 from the transmission section 30 through the downward communication line 61 to each drive control unit 12, 13 (1007 in FIG. g).
The motion control unit 11 also receives the detection data 1003 of position, speed, electric current, etc., from the drive control unit 12, 13, transmitted to the upward communicationline63, diagnosis datalO03Of the current state, a warning, an alarm, etc., and sensor detection data 1004 from the sensor control unit 14 at the reception section 50, buffers the data, the synchronization error correction amount, and the diagnosis data of the current state, a warning, an alarm, etc., of the motion control unit 11 for two control periods 1006 of the drive control unit 12, 13 (B in FIG. g), and transmits from the transmission section 41 to the upward communication 4 line 62 in accordance with the control period 1000 of the numerical control unit 10 (1008 in FIG. I). The numerical control unit 10 receives the transmission data 1008 from the motion control unit 11 by the reception section 40 and monitors the data. Any other operation is similar to that of the third embodiment.
As described above, according to the Both embodiment, the communication lines 60 and 62 connected to the numerical control unit 10 can be used only to transfer data between the numerical control unit 10 at low communication speed and the motion control unit 11, and the communication lines 61 and 63 connected to the drive control units 12 and 13, etc., at high communication speed can be used only to transfer data between the motion control unit 11, the drive control units 12 and 13, and the sensor control unit 14 and therefore the transmission efficiency of the communication lines can be improved.
The motion control unit 11 generates the synchronization error correction control command, whereby the calculationload on the numerical control unit 10 for preparing the synchronization error or the control processing load on the drive control unit 12 for correcting the synchronization error can be reduced.
To increase the number of axes that can be controlled, a drive control unit having the same configuration as the drive control unit 12, 13 is added with the numerical control unit and the drive control units 12 and 13 intact, whereby the number of axes to which synchronization error correction can be made can be increased and by extension it is easily made possible to make the system highly accurate.
Since the sensor information such as the detection data of the acceleration sensor 112 can be acquired independently of the control period of the numerical control unit 10, the suppression frequency of machine resonance can be raised and highly responsive machine positioning is made possible.
Since the drive control unit 12, 13 can directly input the detectiondataoflimitswitch113, 114notviathenumerical control unit 10 and moreover can acquire the detection data independently of the control period of the numerical control unit 10, it is made possible to stop the system without any delay caused by the intervention of any other unit at the emergency time at which a table 106 exceeds the moving range,
for example.
The need for providing the drive control unit 12, 13 with dedicated connectors for receiving the date of the acceleration sensor 112 and the limit switches 113 and 114 is eliminated end by extension a generalpurpose unit can be used es the drive control unit.
Further, the synchronization error correction control command 1002 transmitted by the motion control unit 11 is not bound by the control period of the numerical control unit 10 and it is made possible to suppress the synchronization error amount caused by a disturbance like an impulse in a short time.
In the Lath embodiment, the communication period1006 of each of the motion control unit 11, the drive control units 12 and 13, and the sensor control unit 14 is set to one half the communication period 1000 of the numerical control unit 10. If the communication period is furthermore shortened, for example, to one-third or one-fourth, it is made possible to suppress the synchronization error amount caused by a disturbance like an impulse in a shorter time.
In the embodiment described above, offset correction date of the sensor unit 14 maybe transmitted from the motion control unit 11, etc. In the embodiments described above, the numericalcontrol system using the numerical control unit as the command unit has been described as the servomotor drive control system, but theinvention can also tee applied to the servomotor drive control system of the type wherein the numerical control unit is not used as the command unit.
Claims (4)
1. A servomotor drive control system comprising: a command unit; one or more drive control units for controlling drive of one or more servomotors; a first communication line for transmitting data such as a control command, in a direction of the drive control unit(s) from the command unit; a second communication line for transmitting data such as detection data, in a direction of the command unit from the drive control unit(s); and one or more sensor control units for inputting detection data of one or more sensor(s) and transmitting the data directly to the drive control unit(s) through the first or second communication line; the drive control unit(s) receiving the control command from the command unit transmitted through the first communication line and the detection data of the sensor(s) transmitted through the first or second communication line, and controlling the servomotor(s) based on the received control command and detection data of the sensor(s).
2. The servomotor drive control system as claimed in claim 1, wherein periodic communication between the drive control unit(s) and the sensor control unit(s) is carried out with a communicationlperiod which is set to one-nth of a communication repetition period of the command unit, n being an integer.
3. The servomotor drive control system as claimed in claim 1 or 2, wherein the command unit is a numerical control unit.
4. A servomotor drive control system substantially as described with reference to, and as shown in, Figures 1 to 3 of the accompanying drawings.
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
GB0216732A GB2375844B (en) | 2000-12-19 | 2000-12-19 | Servomotor drive control system |
Publications (3)
Publication Number | Publication Date |
---|---|
GB0421764D0 GB0421764D0 (en) | 2004-11-03 |
GB2404039A true GB2404039A (en) | 2005-01-19 |
GB2404039B GB2404039B (en) | 2005-03-16 |
Family
ID=33548406
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
GB0421764A Expired - Lifetime GB2404039B (en) | 2000-12-19 | 2000-12-19 | Servomotor drive control system |
Country Status (1)
Country | Link |
---|---|
GB (1) | GB2404039B (en) |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5748465A (en) * | 1995-07-20 | 1998-05-05 | Mitsubishi Denki Kabushiki Kaisha | Method of processing data in numerically controlled drive unit |
-
2000
- 2000-12-19 GB GB0421764A patent/GB2404039B/en not_active Expired - Lifetime
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5748465A (en) * | 1995-07-20 | 1998-05-05 | Mitsubishi Denki Kabushiki Kaisha | Method of processing data in numerically controlled drive unit |
Also Published As
Publication number | Publication date |
---|---|
GB0421764D0 (en) | 2004-11-03 |
GB2404039B (en) | 2005-03-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US6794842B2 (en) | Servomotor drive control system | |
US7525263B2 (en) | Control system | |
EP3065012B1 (en) | Control device and method of synchronizing control | |
US8692488B2 (en) | Motor control apparatus for synchronously controlling master axis and slave axis | |
US9541915B2 (en) | Numerical controller having function of switching position control gain during synchronous control | |
EP1564611A2 (en) | Machine controller | |
US20160062342A1 (en) | I/o control system | |
KR20180082359A (en) | Synchronization mechanism for high speed sensor interface | |
CN105480671A (en) | System and method for synchronously controlling multiple conveying chains | |
CN107992109B (en) | Full closed-loop positioning control system and method | |
JP2007213113A (en) | Numerical control system | |
GB2404039A (en) | Servomotor drive control system | |
CN103615999A (en) | Motion synchronization precision detecting device based on linear motors | |
WO2006095401A1 (en) | Drive control system, and machine control device | |
CN109581966A (en) | A kind of numerical control machine bedside member calculates anticollision control system and control method | |
JP2007213154A (en) | Method of transmitting and reproducing positional data of motor, and drive control system for carrying out the same method | |
KR100493606B1 (en) | Servo motor drive control system | |
JP6511457B2 (en) | Multiple communication device | |
CN112385134B (en) | Motor drive control device | |
KR100777928B1 (en) | Method of speed synchronization using PLC | |
US10268183B2 (en) | Control device and method of synchronizing control | |
KR101808421B1 (en) | Pulse gernerator | |
US7333911B2 (en) | Method for operating a position-measuring device and position-measuring device | |
CN103616000A (en) | Motion synchronization precision detection device | |
US12045030B2 (en) | Controller and extrapolation method of command value |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
746 | Register noted 'licences of right' (sect. 46/1977) |
Effective date: 20090305 |
|
PE20 | Patent expired after termination of 20 years |
Expiry date: 20201218 |