Summary of the invention
The technical problem that the present invention will solve is, can't fundamentally solve the problem of the Synchronization Control of AC servo motor to above-mentioned Synchronization Control scheme, and a kind of many motors cross-couplings synchronous control system and method are provided.
The technical scheme that the present invention solves the problems of the technologies described above is; A kind of many motors cross-couplings synchronous control system is provided; Be used to realize the Synchronization Control of two servo control units, said two servo control units are respectively applied for the motor rotation of control different servo and each said servo control unit comprises Position Control subelement, speed control subelement and Current Control subelement; Said system comprises stress detecting unit and stress cross-coupling control unit; Said stress detecting unit is used to detect the stress of two rotating shafts place on the crossbeam of gantry; Said stress cross-coupling control unit, two stress that are used for recording according to said stress detecting unit carry out current compensation to the Current Control subelement of two servo control units.
In many motors cross-couplings synchronous control system of the present invention; Said stress detecting unit comprises the strain gauge of two rotating shafts place that are installed in gantry crossbeam respectively; Said stress cross-coupling control unit comprises that a PID regulates subelement, and a PID regulates subelement and adopts pid control algorithm to calculate the offset of current compensation.
In many motors cross-couplings synchronous control system of the present invention, said system also comprises cross-coupling control unit, position, is used for according to the feedback position information of each rotating shaft the speed control unit of each servo control unit being carried out velocity compensation.
In many motors cross-couplings synchronous control system of the present invention, cross-coupling control unit, said position comprises that the 2nd PID regulates subelement, is used for according to the feedback position information of two rotating shafts and the offset that uses the pid control algorithm computational speed to compensate.
In many motors cross-couplings synchronous control system of the present invention; Cross-coupling control unit, said position comprises the alternate position spike judging unit; Be used for when the alternate position spike of two rotating shafts surpasses the maximum limit of setting, making two servomotors of servo control unit control to shut down, and make the cancellation velocity compensation during less than safety value in the alternate position spike of rotating shaft.
The present invention also provides a kind of many motors cross-couplings synchronisation control means; Be used to realize the Synchronization Control of two servo control units, said two servo control units are respectively applied for the motor rotation of control different servo and each said servo control unit comprises Position Control subelement, speed control subelement and Current Control subelement; Said method comprising the steps of:
(a) stress of two rotating shafts place on the crossbeam of detection gantry;
(b) according to two stress recording the electric current loop of two servo control units is carried out current compensation.
In many motors cross-couplings synchronisation control means of the present invention, the compensation value calculation of said current compensation adopts pid control algorithm.
In many motors cross-couplings synchronisation control means of the present invention, said method also comprises: according to the feedback position information of each rotating shaft the speed ring of each servo control unit is carried out velocity compensation.
In many motors cross-couplings synchronisation control means of the present invention, the compensation value calculation of said velocity compensation adopts pid control algorithm.
In many motors cross-couplings synchronisation control means of the present invention; Comprise before the said velocity compensation: the value of judging the alternate position spike of two rotating shafts; Two servomotors of servo control unit control are shut down, and in the value of said alternate position spike cancellation velocity compensation during less than safety value.
Many motors cross-couplings synchronous control system of the present invention and method through stress detection the carrying out torque adjustment of gantry crossbeam, can reduce the deviation of the absolute position between Synchronization Control axis and the axle.And binding site cross-couplings adjustment of the present invention has better robustness.
Embodiment
In order to make the object of the invention, technical scheme and advantage clearer,, the present invention is further elaborated below in conjunction with accompanying drawing and embodiment.Should be appreciated that specific embodiment described herein only in order to explanation the present invention, and be not used in qualification the present invention.
With reference to figure 1, drive system is made up of servo control unit 10 and motor 14, and wherein motor 14 drives screw mandrel and acts on the workpiece (object) the completion corresponding operating.Servo control unit 10 obtains position command from host control device or upper control module, carries out position closed loop processing, speed closed loop processing and current closed-loop and handles.Particularly, Position Control subelement 11 deducts value of feedback from position command, obtain position deviation, and this position deviation multiply by position gain, carries out position closed loop control, obtains speed command; Speed control subelement 12 deducts speed feedback value from above-mentioned speed command, obtain velocity deviation, carries out ratio, integral control uniform velocity closed-loop process, obtains torque instruction (current-order); Current Control subelement 13 deducts the current feedback value from above-mentioned torque instruction, carry out current closed-loop and handle, and obtains the voltage instruction of each phase, carries out PWM (pulse width modulation) etc., thereby realizes the drive controlling to motor 14.
As shown in Figure 1, be the sketch map of many motors of the present invention cross-couplings synchronous control system first embodiment.In the present embodiment, this system comprises stress detecting unit 15 and stress cross-coupling control unit 16, and wherein stress detecting unit 15 can obtain the stress detected value through two strain gauges 17 that are installed in two rotating shafts place of gantry crossbeam respectively.Especially, above-mentioned stress detecting unit 15 and stress cross-coupling control unit 16 can be integrated into one of them servo control unit 10, perhaps also can be positioned at an independently control device and be connected to two servo control units 10.
Stress detecting unit 15 is used to detect the stress of two rotating shafts place on the crossbeam of gantry.Two stress that stress cross-coupling control unit 16 is used for recording according to the stress detecting unit carry out current compensation to the Current Control subelement of two servo control units.
Because servo control is delivered to Current Control subelement 13 by Position Control subelement 11 and has certain delay; And it is through speed control subelement 12 indirectly-actings; The variation of two rotating shaft stress load can directly be measured in stress cross-coupling control unit 16, and the moment ring is compensated.
Above-mentioned stress cross-coupling control unit 16 can comprise that one the one PID regulates subelement, and it adopts the offset of pid control algorithm calculating current compensation, that is:
Wherein e (i) is the stress difference of two rotating shafts.The torque instruction that Current Control subelement 13 current offset values that 16 calculating obtain according to stress cross-coupling control unit reaches from speed control subelement 12 carries out the current closed-loop processing.
As shown in Figure 2, be the sketch map of many motors of the present invention cross-couplings synchronous control system second embodiment.In the present embodiment; This system comprises cross-coupling control unit, position 28, stress detecting unit 25 and stress cross-coupling control unit 26, and wherein stress detecting unit 25 can obtain the stress detected value through two strain gauges 27 that are installed in two rotating shafts place of gantry crossbeam respectively.Especially; Cross-coupling control unit, above-mentioned position 28, stress detecting unit 25 and stress cross-coupling control unit 26 can be integrated into one of them servo control unit 10, perhaps also can be positioned at an independently control device and be connected to two servo control units 10.
Identical ground with first embodiment, stress detecting unit 25 is used to detect the stress of two rotating shafts place on the crossbeam of gantry.Two stress that stress cross-coupling control unit 26 is used for recording according to the stress detecting unit carry out current compensation to the Current Control subelement 13 of servo control unit 10.
The feedback position information (the for example feedback information of encoder) that cross-coupling control unit, position 28 is used for each rotating shaft that basis links to each other with motor 14 is carried out velocity compensation to the speed control unit 12 of each servo control unit 10.This cross-coupling control unit, position comprises that one the 2nd PID regulates subelement, is used for according to the feedback position information of two rotating shafts and the offset that uses the pid control algorithm computational speed to compensate, that is:
Wherein e (i) is the alternate position spike of two rotating shafts.The speed command that speed control subelement 12 velocity compensated value that 28 calculating obtain according to cross-coupling control unit, position reaches from Position Control subelement 11 carries out ratio, integral control uniform velocity closed-loop process, obtains torque instruction.
In said system, cross-coupling control unit, position 28 also comprises the alternate position spike judging unit, is used for when the alternate position spike of two rotating shafts surpasses the maximum limit △ Xlim that sets, and to servo control unit 10 output orders, controls two servomotors 14 and shuts down.Above-mentioned △ Xlim be two rotating shafts the limiting value of patient alternate position spike, when the alternate position spike of two rotating shafts surpasses this limiting value, gently then damage screw mandrel, more serious is may cause the damage that can not repair to lathe.Therefore,, need carry out system alarm in case the error of two rotating shafts reaches this limiting value, and the stall immediately of control motor.
Above-mentioned alternate position spike judging unit also makes the 2nd PID regulate subelement cancellation velocity compensation in the alternate position spike of two rotating shafts during less than safety value △ Xmin.△ Xmin is the safety value of two rotating shaft position differences, should be worth through being provided with, and can reduce the amount of calculation of system.When the alternate position spike of two rotating shafts is worth less than this, can think that two rotating shafts are in synchronous regime, and need not compensate that preserve the error of two rotating shafts this moment as the basis of calculating next time, so that participate in calculating when needing offset value calculation next time.
Above-mentioned maximum limit △ Xlim and safety value △ Xmin can set according to different application scenes.Usually the value of high more maximum limit △ Xlim of required precision and safety value △ Xmin is more little.
Above-mentioned cross-coupling control unit, position 28 all adopts the cross-coupling control mode with stress cross-coupling control unit 26; Be that feedack returns to two servo control units 10 simultaneously; And in two servo control units, regulate simultaneously, increased the efficient of regulating greatly.
As shown in Figure 3, be the sketch map of many motors of the present invention cross-couplings synchronisation control means first embodiment.This method is used to realize the Synchronization Control of two servo control units, and above-mentioned two servo control units are respectively applied for the motor rotation of control different servo and each servo control unit comprises position ring, speed ring and electric current loop.This method may further comprise the steps:
Step S31: the stress that detects two rotating shafts place on the crossbeam of gantry.In this step, can obtain the stress detected value through two strain gauges that are installed in two rotating shafts place of gantry crossbeam respectively.
Step S32: the electric current loop of two servo control units is carried out current compensation according to two stress that record.The offset of above-mentioned current compensation can adopt pid control algorithm to calculate, that is:
Wherein e (i) is the stress difference of two rotating shafts.The electric current loop of servo control unit carries out the current closed-loop processing according to the torque instruction that the current offset values of calculating acquisition reaches from speed ring.
In second embodiment of many motors of the present invention cross-couplings synchronisation control means, as shown in Figure 4 except comprising above-mentioned steps S31, S32, further comprising the steps of:
Step S41: the alternate position spike of calculating two rotating shafts.The position of above-mentioned each rotating shaft can obtain through encoder.
Step S42: whether judge above-mentioned alternate position spike greater than the maximum limit △ Xlim that sets, if alternate position spike is greater than above-mentioned maximum limit △ Xlim, then execution in step S43; Otherwise execution in step S44.
Step S43:, control two servomotors and shut down to the servo control unit output order.
Step S44: whether the alternate position spike of judging two rotating shafts less than safety value △ Xmin, and at alternate position spike execution in step S46 during less than safety value △ Xmin, otherwise execution in step S45.
Step S45: the speed ring through servo control unit carries out velocity compensation.Particularly, this step is used the offset of pid control algorithm computational speed compensation, that is:
Wherein e (i) is the alternate position spike of two rotating shafts.Speed ring carries out ratio, integral control uniform velocity closed-loop process with the speed command that above-mentioned velocity compensated value reaches from position ring, obtains torque instruction.
Step S46: directly the alternate position spike of two rotating shafts is preserved as the basis of calculating next time,, and return step S41 so that participate in calculating when needing offset value calculation next time.
The above; Be merely the preferable embodiment of the present invention, but protection scope of the present invention is not limited thereto, any technical staff who is familiar with the present technique field is in the technical scope that the present invention discloses; The variation that can expect easily or replacement all should be encompassed within protection scope of the present invention.Therefore, protection scope of the present invention should be as the criterion with the protection range of claim.