CN1529215A - Motor controlling device - Google Patents
Motor controlling device Download PDFInfo
- Publication number
- CN1529215A CN1529215A CNA031326447A CN03132644A CN1529215A CN 1529215 A CN1529215 A CN 1529215A CN A031326447 A CNA031326447 A CN A031326447A CN 03132644 A CN03132644 A CN 03132644A CN 1529215 A CN1529215 A CN 1529215A
- Authority
- CN
- China
- Prior art keywords
- mechanical
- instruction
- controller
- motor
- mentioned
- 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
- 230000033001 locomotion Effects 0.000 claims abstract description 11
- 238000000034 method Methods 0.000 claims description 26
- 230000001133 acceleration Effects 0.000 claims description 20
- 230000000694 effects Effects 0.000 claims description 6
- 238000004519 manufacturing process Methods 0.000 abstract description 3
- 239000004065 semiconductor Substances 0.000 abstract description 3
- 238000006243 chemical reaction Methods 0.000 description 7
- 230000005484 gravity Effects 0.000 description 3
- 230000001360 synchronised effect Effects 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 1
- 230000015572 biosynthetic process Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 239000000203 mixture Substances 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
Images
Landscapes
- Control Of Multiple Motors (AREA)
- Control Of Position Or Direction (AREA)
Abstract
The invention discloses motor (including synchro motor, DC motor, asynchronous motor, linear motor etc.) controlling device applicable to drive and control for machine, semiconductor manufacture equipment and robot. The device includes NC (numerical control) controller (1), servo current controller (4) of first mechanical axis, servo current controller (5) of second mechanical axis, servo motor (6), (7) for first, second mechanical axis respectively, mechanical platform (8). Characters of the device are as following: based on first NC position instruction r1, second NC position instruction r2, feed back x1 at first position and feed back x2 at second position, first and second torque instruction ft1 and ft2, combination controller (9) makes platform (8) produce mechanical motion according to NC controller. the invention improves issues of vibration, weak capability of anti interference and slow mechanical response etc. so as to raise precision of actual locus of platform.
Description
Technical field: the present invention relates to a kind of motor (comprising synchronous motor, direct current generator, asynchronous machine, linear electric motors etc.) control device, can be used for the driving and the control of lathe, semiconductor manufacturing equipment and robot etc.
Background technology: adopting motor (to comprise synchronous motor at present, direct current generator, asynchronous machine, when linear electric motors etc.) the arm even load of the platform of lathe, semiconductor manufacturing equipment or robot being controlled, general all be earlier as the upper control part generation position command of NC etc., servomotor is controlled by this instruction by servomechanism then.Fig. 2 is the structural representation of existing motor control assembly.On the formation of physical construction, as shown in Figure 9, the first mechanical axis mechanical control device, 2, the first mechanical axis servo current controllers 4 constitute as a separate unit, are commonly referred to the first mechanical axis servo controller 17.Equally, as shown in figure 10, the second mechanical axis mechanical control device, 3, the second mechanical axis servo current controllers 5 constitute the second mechanical axis servo controller 18 as a separate unit.Each servomotor then is assembled between mechanical platform 8 and the lathe bed body according to the requirement of mechanical platform 8.NC controller 1 also is one and independently constitutes the unit.Between the NC controller 1 and the first mechanical axis servo controller 17 and the second mechanical axis servo controller 18, generally connect with cable, optical cable or special-purpose socket.Between the first mechanical axis servo controller 17 and the first mechanical axis servomotor 6, generally connect with cable.Between the second mechanical axis servo controller 18 and the second mechanical axis servomotor 7, generally connect with cable.As the NC controller 1 of upper control part, can when generating a NC position command r1 and the 2nd NC position command r2, monitor the primary importance feedback x1 and the second place feedback x2 of each servomotor working condition of reflection.The one NC position command r1 and the 2nd NC position command r2 can have following instruction type to transmit.The period of time T n of its transmission is generally greater than the control cycle Ti of mechanical control device Tj or current controller.Because the result of cycle occasion is easy to draw by analogizing At All Other Times, below only press Tn=4*Tj ... (1) occasion describes.Owing to no matter be absolute position instruction, relative position instruction and differential position instruction, utilize prior art all can be easy to be converted to other forms of instruction.For this reason, below will be only the occasion of absolute position instruction type be wherein described.Because a NC position command r1 is constant in period of time T n, so the first mechanical axis mechanical control device 2 when controlling computing, generally carries out following conversion earlier.
rc1(K*Tn)＝r1((K-1)*Tn)……(2)
rc1(K*Tn+k*Tj)＝rc1(K*Tn+(k-1)*Tj)+Vc((K-1)*Tn)*Tj……(3)
Vc1((K-1)*Tn)＝r1(K*Tn)-r1((K-1)*Tn)/Tn……(4)
K＝0，1?，2，，，，……(5)
k＝0，1，2，3……(6)
Simultaneously, carry out unit conversion with one among the first motor position xm1 and the rc1, make that both units are unified.Afterwards, with rc1 the instruction in the period T j, the first mechanical axis mechanical control device 2 is finished required machinery control computing in period T j, provide the first torque instruction fr1 to the first mechanical axis servo current controller 4.4 of the first mechanical axis servo current controllers are instruction with the first torque instruction fr1, the first mechanical axis servomotor 6 is carried out Current Control etc., make the first Mechanical Driven power f1 of mechanical axis servomotor 6 outputs of winning the same substantially with the first torque instruction fr1.Because the principle of work of the second mechanical axis mechanical control device, 3, the second mechanical axis servo current controllers, 5, the second mechanical axis servomotors 7 is same as described above, in the explanation of this omission to them.Two shaft mechanical platforms 8 in general, it has as Fig. 4, Fig. 5, three kinds of versions shown in Figure 6.Corresponding to structure shown in Figure 4, as shown in Figure 7, when by the P2 point, the speed command vector V of NC will be from the sharp V2 that becomes of V1 acutely.Because two shaft mechanical platforms 8 are inertia systems, the property the jumped over variation of its speed can't realize, so, on the actual path of two shaft mechanical platforms 8, will occur such as the excess of stroke, vibrate, walk in problem such as a little less than envelope curve and the antijamming capability.Corresponding to structure shown in Figure 5, because two shaft mechanical platforms 8 are not still according to the size of the first Mechanical Driven power f1 and the second Mechanical Driven power f2, but also to reach the sense of rotation that centers on center of gravity in its resultant direction and make mechanical movement simultaneously according to their center of effort.At this moment, on the first mechanical axis mechanical control device 2 and the second mechanical axis mechanical control device 3 shown in Figure 2, just can't touch the design that type carries out controller, also just can't obtain satisfied control result at machinery shown in Figure 4.So, on the actual path of two shaft mechanical platforms 8, will occur such as the excess of stroke, vibration, a little less than the antijamming capability, automatic reaction waits problem slowly.Corresponding to structure shown in Figure 6, because two servomotor acting forces are on same direction, the first Mechanical Driven power f1 and the second Mechanical Driven power f2 will interfere.And between the first mechanical axis mechanical control device 2 and the second mechanical axis mechanical control device 3 shown in Figure 2, the message exchange that there is no need, the influence that just can't eliminate this interference fully and brought.So, a little less than will occurring on the actual path of two shaft mechanical platforms 8 such as the excess of stroke, vibration, antijamming capability and automatic reaction wait problem slowly.
Summary of the invention: purpose of the present invention just is to utilize the NC controller 1 that has possessed in the original motor control assembly, the first mechanical axis servo current controller 4, the second mechanical axis servo current controller 5, the first mechanical axis servomotor 6, the second mechanical axis servomotor 7, the condition of the software and hardware of mechanical platform 8, by appending general controller 9 and the original first mechanical axis mechanical control device 2 and the second mechanical axis mechanical control device, 3 not available control compute modes being provided, thereby improve the excess of stroke of two shaft mechanical platforms 8, walk interior envelope curve, vibration, antijamming capability is weak to wait problem slowly with automatic reaction, improves its actual path accuracy.The present invention is achieved by following proposal: a kind of motor control assembly, it comprises having generation the one NC position command r1 and the 2nd NC position command r2 and monitor primary importance feedback x1 and the NC controller 1 of second place feedback x2, generate the first mechanical axis servo current controller 4 of the first electric power signal V1 and primary importance feedback x1 according to the first torque instruction fr1 and the first motor position xm1, generate the second mechanical axis servo current controller 5 of the second electric power signal V2 and second place feedback x2 according to the second torque instruction fr2 and the second motor position xm2, generate the first Mechanical Driven power f1 and the first mechanical axis servomotor 6 of the first motor position xm1 is provided according to the above-mentioned first electric power signal V1, generate the second Mechanical Driven power f2 and the second mechanical axis servomotor 7 of the second motor position xm2 is provided according to the above-mentioned second electric power signal V2, under the effect of above-mentioned first Mechanical Driven power f1 and the above-mentioned second Mechanical Driven power f2, produce the mechanical platform 8 of mechanical motion, it is characterized in that it also comprises: according to an above-mentioned NC position command r1, the 2nd NC position command r2, primary importance feedback x1 and second place feedback x2, generate the first torque instruction fr1 and the second torque instruction fr2, make mechanical platform 8 produce the general controller 9 of mechanical motion by the requirement of NC controller 1.Motor control assembly of the present invention is owing to introduced general controller 9, just can provide the original first mechanical axis mechanical control device 2 and the second mechanical axis mechanical control device, 3 not available control compute modes by general controller 9, thereby improve two shaft mechanical platforms 8 the excess of stroke, walk the weak and automatic reaction of interior envelope curve, vibration, antijamming capability and wait problem slowly, improved mechanical platform actual path precision.
The present invention also provides a kind of motor control assembly, it comprises having generation the one NC position command r1 and the 2nd NC position command r2 and monitor primary importance feedback x1 and the NC controller 1 of second place feedback x2, generate the first Mechanical Driven power f1 and the first mechanical axis servomotor 6 of the first motor position xm1 is provided according to the first electric power signal V1, generate the second Mechanical Driven power f2 and the second mechanical axis servomotor 7 of the second motor position xm2 is provided according to the second electric power signal V2, under the effect of the first Mechanical Driven power f1 and the second Mechanical Driven power f2, produce the mechanical platform 8 of mechanical motion, it is characterized in that it also comprises: according to an above-mentioned NC position command r1, the 2nd NC position command r2, the primary importance feedback x1 and the second place are fed back x2, generate the general controller 9 of the first torque instruction fr1 and the second torque instruction fr2; Has the position control method of operation, the speed control method of operation, the torque control method of operation, and be set under the condition of the torque control method of operation, generate the first mechanical axis servo controller 17 of the first electric power signal V1 and primary importance feedback x1 according to the above-mentioned first torque instruction fr1 and the first motor position xm1; Has the position control method of operation, the speed control method of operation, the torque control method of operation, and be set under the condition of the torque control method of operation, generate the second mechanical axis servo controller 18 of the second electric power signal V2 and second place feedback x2 according to the above-mentioned second torque instruction fr2 and the second motor position xm2.Motor control assembly of the present invention is owing to introduced general controller 9, just can provide the original first mechanical axis mechanical control device 2 and the second mechanical axis mechanical control device, 3 not available control compute modes by general controller 9, thereby improve two shaft mechanical platforms 8 the excess of stroke, walk the weak and automatic reaction of interior envelope curve, vibration, antijamming capability and wait problem slowly, improve its actual path accuracy.Simultaneously, when original motor control assembly is transformed, owing to utilized the first mechanical axis servo controller 17 and the second mechanical axis servo controller 18 that have possessed in original motor control assembly, and do not append new servo controller, transform the required time of original motor control assembly thereby reduced to transform the required financial cost of original motor control assembly and shortened.
Description of drawings: Fig. 1 is the structural representation of the motor control assembly of first embodiment of the invention, Fig. 2 is the structural representation of original motor control assembly, Fig. 3 is the structural representation of the motor control assembly of second embodiment, Fig. 4 is first kind of structural representation of the mechanical platform 8 of motor control assembly, Fig. 5 is second kind of structural representation of the mechanical platform 8 of motor control assembly, Fig. 6 is the third structural representation of the mechanical platform 8 of motor control assembly, Fig. 7 is the synoptic diagram of the NC instruction of original motor control assembly, Fig. 8 is the structural representation of the general controller 9 of the 3rd embodiment, Fig. 9 is the structural representation of the first mechanical axis servo controller 17 in second embodiment, and Figure 10 is the structural representation of the second mechanical axis servo controller 18 in second embodiment.
Specific embodiments one: specify the present embodiment below in conjunction with Fig. 1.It generates a NC position command r1 and the 2nd NC position command r2 and monitors primary importance feedback x1 and the NC controller 1 of second place feedback x2 by having, generate the first mechanical axis servo current controller 4 of the first electric power signal V1 and primary importance feedback x1 according to the first torque instruction fr1 and the first motor position xm1, generate the second mechanical axis servo current controller 5 of the second electric power signal V2 and second place feedback x2 according to the second torque instruction fr2 and the second motor position xm2, generate the first Mechanical Driven power f1 and the first mechanical axis servomotor 6 of the first motor position xm1 is provided according to the above-mentioned first electric power signal V1, generate the second Mechanical Driven power f2 and the second mechanical axis servomotor 7 of the second motor position xm2 is provided according to the above-mentioned second electric power signal V2, under the effect of above-mentioned first Mechanical Driven power f1 and the above-mentioned second Mechanical Driven power f2, produce the mechanical platform 8 of mechanical motion, according to an above-mentioned NC position command r1, the 2nd NC position command r2, primary importance feedback x1 and second place feedback x2, generate the first torque instruction fr1 and the second torque instruction fr2, make mechanical platform 8 produce general controller 9 compositions of mechanical motion by the requirement of NC controller 1.NC controller 1, the first mechanical axis servo current controller 4, the second mechanical axis servo current controllers 5, the first mechanical axis servomotors 6, the second mechanical axis servomotors 7, mechanical platform 8 is identical with original mode.Omission is to their detailed description.Below, describe for structure shown in Figure 6 at mechanical platform 8.At this moment, the one NC position command r1 is the position command of lower platform to ground, the 2nd NC position command r2 is the position command of upper mounting plate to ground, and primary importance feedback x1 is the physical location of lower platform to ground, and second place feedback x2 is the physical location of upper mounting plate to ground.General controller 9 generates the first torque instruction fr1 and the second torque instruction fr2 by following computing.Wherein, s is a differentiating operator, KP1, and Kv1, Ki1 are the ride gain at lower platform, KP2, Kv2, Ki2 are the ride gain at upper mounting plate, and m1 is the quality of lower platform, and m2 is the quality of upper mounting plate.
fr2＝m2*(Kp2*(r2-x2)-s*x2)*(Ki2/s+Kv2)……(7)
fr1＝m1*(Kp1*(r1-x1)-s*x1)*(Ki1/s+Kv1)-fr2……(8)
Because by (7), the interference problem of last lower platform has been eliminated in the computing of (8) formula fully, thereby has improved the kinetic characteristic of two shaft mechanical platforms 8, and its actual path accuracy is improved.And (7), the computing of (8) formula can't be achieved on original system architecture.
Specific embodiments two: specify the present embodiment below in conjunction with Fig. 3.It generates a NC position command r1 and the 2nd NC position command r2 and monitors primary importance feedback x1 and the NC controller 1 of second place feedback x2 by having, generate the first Mechanical Driven power f1 and the first mechanical axis servomotor 6 of the first motor position xm1 is provided according to the first electric power signal V1, generate the second Mechanical Driven power f2 and the second mechanical axis servomotor 7 of the second motor position xm2 is provided according to the second electric power signal V2, under the effect of the first Mechanical Driven power f1 and the second Mechanical Driven power f2, produce the mechanical platform 8 of mechanical motion, according to an above-mentioned NC position command r1, the 2nd NC position command r2, the primary importance feedback x1 and the second place are fed back x2, generate the general controller 9 of the first torque instruction fr1 and the second torque instruction fr2; Has the position control method of operation, the speed control method of operation, the torque control method of operation, and be set under the condition of the torque control method of operation, generate the first mechanical axis servo controller 17 of the first electric power signal V1 and primary importance feedback x1 according to the above-mentioned first torque instruction fr1 and the first motor position xm1; Has the position control method of operation, the speed control method of operation, the torque control method of operation, and be set under the condition of the torque control method of operation, the second mechanical axis servo controller 18 that generates the second electric power signal V2 and second place feedback x2 according to the above-mentioned second torque instruction fr2 and the second motor position xm2 is formed.NC controller 1, the first mechanical axis servomotor 6, the second mechanical axis servomotors 7, mechanical platform 8 is identical with original mode.Omission is to their detailed description.The first mechanical axis servo controller 17 shown in Figure 9 is the servo controller in original motor control assembly, but its control mode is set at the torque control method of operation.At this moment the first mechanical axis servo current controller 4 of the first mechanical axis servo controller 17, the first torque instruction fr1 and the first motor position xm1 that provide according to the outside of the first mechanical axis servo controller 17 generate the first electric power signal V1 and primary importance feedback x1.The second mechanical axis servo controller 18 shown in Figure 10 is the servo controller in original motor control assembly, but its control mode is set at the torque control method of operation.At this moment the second mechanical axis servo current controller 5 of the second mechanical axis servo controller 18, the second torque instruction fr2 and the first motor position xm2 that provide according to the outside of the second mechanical axis servo controller 18 generate the first electric power signal V2 and second place feedback x2.Below, describe for structure shown in Figure 6 at mechanical platform 8.At this moment, the one NC position command r1 is the position command of lower platform to ground, the 2nd NC position command r2 is the position command of upper mounting plate to ground, and primary importance feedback x1 is the physical location of lower platform to ground, and second place feedback x2 is the physical location of upper mounting plate to ground.General controller 9 generates the first torque instruction fr1 and the second torque instruction fr2 by the computing of (7), (8) formula.Owing to by the computing of (7), (8) formula, eliminated the interference problem of last lower platform fully, thereby improved the kinetic characteristic of two shaft mechanical platforms 8, its actual path accuracy is improved.And the computing of (7), (8) formula can't be achieved on original system architecture.Simultaneously, when original motor control assembly is transformed, owing to utilized the first mechanical axis servo controller 17 and the second mechanical axis servo controller 18 that have possessed in original motor control assembly, and do not append new servo controller, transform the required time of original motor control assembly thereby reduced to transform the required financial cost of original motor control assembly and shortened.
Specific embodiments three: specify the present embodiment below in conjunction with Fig. 8.The present embodiment and embodiment one or twos' difference is, general controller 9 in this motor control assembly comprises: according to an above-mentioned NC position command r1, the 2nd NC position command r2 generates the instruction reductor 10 of first real time position instruction rt1 and second real time position instruction rt2; According to above-mentioned first real time position instruction rt1, second real time position instruction rt2, primary importance feedback x1, second place feedback x2 generates first real time acceleration instruction ft1, the two shaft mechanical controllers 11 of second real time acceleration instruction ft2; According to above-mentioned generation first real time acceleration instruction ft1, second real time acceleration instruction ft2 generates the directive distributor 12 of the first torque instruction fr1 and the second torque instruction fr2.Below, describe for structure shown in Figure 4 at mechanical platform 8.The one NC position command r1 is the position command of x platform, and second real time position instruction rt2 is the position command of y platform, and primary importance feedback x1 is the feedback position of x platform, and second place feedback x2 is the feedback position of y platform.Instruction reductor 10, according to an above-mentioned NC position command r1, the 2nd NC position command r2 by following computing, generates first real time position instruction rt1 and second real time position instruction rt2.
rc1(K*Tn)＝r1((K-1)*Tn)……(9)
Vn1((K-1)*K*Tn)＝r1(K*Tn)-r1((K-1)*Tn)/Tn……(10)
Vm1((K-1)*Tn)＝(Vn1((K-1)*Tn)+Vn1(K*Tn))/2……(11)
Vc1(K*Tn)＝Vm1((K-1)*Tn)……(12)
A1(K*Tn)＝(3*r1(K*Tn)-3*r1((K-1)*Tn)-10*Tj*Vm1((K-1)*K*Tn)-2*Tj*Vm1(K*Tn)/(10*Tj*Tj)……(13)
a1(K*Tn)＝(2*r1((K-1)*Tn)-2*r1(K*Tn)+3*Vm1(K*Tn)*Tj+5*Vm1((K-1)*Tn)*Tj)/(10*Tj*Tj)……(14)
A1(K*Tn+k*Tj)＝A1(K*Tn)+a1(K*Tn)*k……(15)
Vc1(K*Tn+(k+1)*Tj)＝Vc1(K*Tn+k*Tj)+A1(K*Tn+(k+1)*Tj)*Tj……(16)
rc1(K*Tn+(k+1)*Tj)＝rc1(K*Tn+k*Tj)+Vc1(K*Tn+k*Tj)*Tj……(17)
rc2(K*Tn)＝r2((K-1)*Tn)……(18)
Vn2((K-1)*K*Tn)＝r2(K*Tn)-r2((K-1)*Tn)/Tn……(19)
Vm2((K-1)*Tn)＝(Vn2((K-1)*Tn)+Vn2(K*Tn))/2……(20)
Vc2(K*Tn)＝Vm2((K-1)*Tn)……(21)
A2(K*Tn)＝(3*r2(K*Tn)-3*r2((K-1)*Tn)-10*Tj*Vm2((K-1)*K*Tn)-2*Tj*Vm2(K*Tn))/(10*Tj*Tj)……(22)
a2(K*Tn)＝(2*r2((K-1)*Tn)-2*r2(K*Tn)+3*Vm2(K*Tn)*Tj+5*Vm2((K-1)*Tn)*Tj)/(10*Tj*Tj)……(23)
A2(K*Tn+k*Tj)＝A2(K*Tn)+a2(K*Tn)*k……(24)
Vc2(K*Tn+(k+1)*Tj)＝Vc2(K*Tn+k*Tj)+A2(K*Tn+(k+1)*Tj)*Tj……(25)
rc2(K*Tn+(k+1)*Tj)＝rc2(K*Tn+k*Tj)+Vc2(K*Tn+k*Tj)*Tj……(26)
rt1＝rc1……(27)
rt2＝rc2……(28)
Two shaft mechanical controllers 11 are according to above-mentioned first real time position instruction rt1, second real time position instruction rt2, primary importance feedback x1, second place feedback x2 is by following control computing, generate first real time acceleration instruction ft1, second real time acceleration instruction ft3.Wherein, KP1, Kv1, Ki1 are the ride gain at the x platform, KP2, Kv2, Ki2 are the ride gain at the y platform, and m1 is the quality of x platform, and m2 is the quality of y platform.
ft2＝m2*(Kp2*(rt2-x2)-s*x2)*(Ki2/s+Kv2)……(29)
ft1＝m1*(Kp1*(rt1-x1)-s*x1)*(Ki1/s+Kv1)……(30)
Directive distributor 12, according to above-mentioned generation first real time acceleration instruction ft1, second real time acceleration instruction ft2 exports the first torque instruction fr1 and the second torque instruction fr2 by following mode.
fr1＝ft1……(31)
fr2＝ft2……(32)
Because according to the Vc1 that above computing draws, Vc2 has not had jump phenomena on P2 point shown in Figure 7, thereby has improved the kinetic characteristic of two shaft mechanical platforms 8, makes its actual path accuracy be able to bigger raising.
Specific embodiments four: the present embodiment is described below in conjunction with Fig. 8.The difference of the present embodiment and embodiment one is, general controller 9 in this motor control assembly comprises: according to an above-mentioned NC position command r1, the 2nd NC position command r2 generates the instruction reductor 10 of first real time position instruction rt1 and second real time position instruction rt2; According to above-mentioned first real time position instruction rt1, second real time position instruction rt2, primary importance feedback x1, second place feedback x2 generates first real time acceleration instruction ft1, the two shaft mechanical controllers 11 of second real time acceleration instruction ft2; According to above-mentioned generation first real time acceleration instruction ft1, second real time acceleration instruction ft2 generates the directive distributor 12 of the first torque instruction fr1 and the second torque instruction fr2.Below, describe for structure shown in Figure 5 at mechanical platform 8.The one NC position command r1 is the first mechanical axis position command of mechanical platform 8, second real time position instruction rt2 is the second mechanical axis position command of mechanical platform 8, primary importance feedback x1 is the first mechanical axis feedback position of mechanical platform 8, and second place feedback x2 is the second mechanical axis feedback position of mechanical platform 8.Instruction reductor 10, according to an above-mentioned NC position command r1, the 2nd NC position command r2 by the computing of (9)～(28) formula, generates first real time position instruction rt1 and second real time position instruction rt2.Two shaft mechanical controllers 11 are according to above-mentioned first real time position instruction rt1, second real time position instruction rt2, primary importance feedback x1, second place feedback x2 is by following control computing, generate first real time acceleration instruction ft1, second real time acceleration instruction ft2.Wherein, KP1, Kv1, Ki1 is the ride gain at the sense of rotation of mechanical platform 8, KP2, Kv2, Ki2 is the ride gain at the translation direction of mechanical platform 8, Jm is the moment of inertia of mechanical platform 8, and M is the quality of mechanical platform 8, and R is the distance between the center of effort of first mechanical axis and second mechanical axis.
ft1＝Jm*(Kp1*(rt1-rt2)/R-(x1-x2)/R)-s*x1)*(Ki1/s+Kv1)……(33)
ft2＝M*(Kp2*(rt1+rt2)/2-(x1+x2)/2)-s*(x1+x2)/2)*(Ki2/s+Kv2)……(34)
Directive distributor 12, according to above-mentioned generation first real time acceleration instruction ft1, second real time acceleration instruction ft2 by following computing, generates the first torque instruction fr1 and the second torque instruction fr2.Wherein, Rx is the distance between the rotation center of gravity of the center of effort of first mechanical axis and mechanical platform 8, the distance between the center of effort of Ry second mechanical axis and the rotation center of gravity of mechanical platform 8.
fr1＝ft2+ft1*Rx……(35)
fr2＝ft2-ft1*Ry……(36)
In the first torque instruction fr1 and the second torque instruction fr2 that draw according to above computing, solved the interference problem between first mechanical axis and first mechanical axis, thereby improved the kinetic characteristic of two shaft mechanical platforms 8, made its actual path accuracy be able to bigger raising.
Claims (3)
1, a kind of motor control assembly, it comprises having generation the one NC position command r1 and the 2nd NC position command r2 and monitor primary importance feedback x1 and the NC controller (1) of second place feedback x2, generate the first mechanical axis servo current controller (4) of the first electric power signal V1 and primary importance feedback x1 according to the first torque instruction fr1 and the first motor position xm1, generate the second mechanical axis servo current controller (5) of the second electric power signal V2 and second place feedback x2 according to the second torque instruction fr2 and the second motor position xm2, generate the first Mechanical Driven power f1 and the first mechanical axis servomotor (6) of the first motor position xm1 is provided according to the above-mentioned first electric power signal V1, generate the second Mechanical Driven power f2 and the second mechanical axis servomotor (7) of the second motor position xm2 is provided according to the above-mentioned second electric power signal V2, under the effect of above-mentioned first Mechanical Driven power f1 and the above-mentioned second Mechanical Driven power f2, produce the mechanical platform (8) of mechanical motion, it is characterized in that it also comprises: according to an above-mentioned NC position command r1, the 2nd NC position command r2, primary importance feedback x1 and second place feedback x2, generate the first torque instruction fr1 and the second torque instruction fr2, make mechanical platform (8) produce the general controller (9) of mechanical motion by the requirement of NC controller (1).
2. motor control assembly, it comprises having generation the one NC position command r1 and the 2nd NC position command r2 and monitor primary importance feedback x1 and the NC controller (1) of second place feedback x2, generate the first Mechanical Driven power f1 and the first mechanical axis servomotor (6) of the first motor position xm1 is provided according to the first electric power signal V1, generate the second Mechanical Driven power f2 and the second mechanical axis servomotor (7) of the second motor position xm2 is provided according to the second electric power signal V2, under the effect of the first Mechanical Driven power f1 and the second Mechanical Driven power f2, produce the mechanical platform (8) of mechanical motion, it is characterized in that it also comprises: according to an above-mentioned NC position command r1, the 2nd NC position command r2, the primary importance feedback x1 and the second place are fed back x2, generate the general controller (9) of the first torque instruction fr1 and the second torque instruction fr2; Has the position control method of operation, the speed control method of operation, the torque control method of operation, and be set under the condition of the torque control method of operation, generate the first mechanical axis servo controller (17) of the first electric power signal V1 and primary importance feedback x1 according to the above-mentioned first torque instruction fr1 and the first motor position xm1; Has the position control method of operation, the speed control method of operation, the torque control method of operation, and be set under the condition of the torque control method of operation, generate the second mechanical axis servo controller (18) of the second electric power signal V2 and second place feedback x2 according to the above-mentioned second torque instruction fr2 and the second motor position xm2.
As above-mentioned claim 1 or 2 described in motor control assembly, it is characterized in that described general controller (9) comprising: according to an above-mentioned NC position command r1, the 2nd NC position command r2 generates the instruction reductor (10) of first real time position instruction rt1 and second real time position instruction rt2; According to above-mentioned first real time position instruction rt1, second real time position instruction rt2, primary importance feedback x1, second place feedback x2 generates first real time acceleration instruction ft1, the two shaft mechanical controllers 11 of second real time acceleration instruction ft2; According to above-mentioned generation first real time acceleration instruction ft1, second real time acceleration instruction ft2 generates the directive distributor (12) of the first torque instruction fr1 and the second torque instruction fr2.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CNB031326447A CN1299174C (en) | 2003-09-27 | 2003-09-27 | Motor controlling device |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CNB031326447A CN1299174C (en) | 2003-09-27 | 2003-09-27 | Motor controlling device |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN1529215A true CN1529215A (en) | 2004-09-15 |
| CN1299174C CN1299174C (en) | 2007-02-07 |
Family
ID=34286065
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CNB031326447A Expired - Fee Related CN1299174C (en) | 2003-09-27 | 2003-09-27 | Motor controlling device |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN1299174C (en) |
Cited By (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102179770A (en) * | 2011-03-22 | 2011-09-14 | 铁道第三勘察设计院集团有限公司 | Method for uniformly controlling rail plate numerical control grinding machine |
| CN102201766A (en) * | 2010-03-22 | 2011-09-28 | 东元电机股份有限公司 | Motor driver |
| CN101938234B (en) * | 2009-08-27 | 2012-06-06 | 上汽通用五菱汽车股份有限公司 | Method and system for synchronizing empty chain and floor chain on automobile assembly line |
| CN101651441B (en) * | 2009-09-07 | 2012-07-04 | 湖南中泰特种装备有限责任公司 | Electric transmission system for HSHM-PE fiber back drawing machine |
| CN103812392A (en) * | 2012-11-08 | 2014-05-21 | 沈阳新松机器人自动化股份有限公司 | Motor driving controller and dual-motor control method thereof |
| CN106533270A (en) * | 2015-09-09 | 2017-03-22 | 山洋电气株式会社 | Motor control device |
Family Cites Families (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS5862707A (en) * | 1981-10-09 | 1983-04-14 | Fanuc Ltd | Numerical control system |
| EP0425689B1 (en) * | 1989-04-26 | 1995-11-02 | Fanuc Ltd. | Method of controlling main shaft rotation |
| JP2518457B2 (en) * | 1990-07-05 | 1996-07-24 | 三菱電機株式会社 | How to synchronize the feed axis of the lathe |
| JPH06126594A (en) * | 1992-10-22 | 1994-05-10 | Nippei Toyama Corp | Cnc grinding machine with synchronous control device based on positional deviation correction |
| JPH06284774A (en) * | 1993-03-24 | 1994-10-07 | Fuji Electric Co Ltd | Method and apparatus for synchronous operation of machine tool |
| DE19882519B4 (en) * | 1997-07-02 | 2005-12-22 | Mitsubishi Denki K.K. | Synchronization control unit for a servomotor |
| JPH11187699A (en) * | 1997-12-24 | 1999-07-09 | Hitachi Ltd | Speed control method for induction motor |
| CN1225078C (en) * | 2000-07-03 | 2005-10-26 | 卢骥 | Frequency-conversion voltage-varying speed control method with high-torque vector control for asynchronous motor |
-
2003
- 2003-09-27 CN CNB031326447A patent/CN1299174C/en not_active Expired - Fee Related
Cited By (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101938234B (en) * | 2009-08-27 | 2012-06-06 | 上汽通用五菱汽车股份有限公司 | Method and system for synchronizing empty chain and floor chain on automobile assembly line |
| CN101651441B (en) * | 2009-09-07 | 2012-07-04 | 湖南中泰特种装备有限责任公司 | Electric transmission system for HSHM-PE fiber back drawing machine |
| CN102201766A (en) * | 2010-03-22 | 2011-09-28 | 东元电机股份有限公司 | Motor driver |
| CN102179770A (en) * | 2011-03-22 | 2011-09-14 | 铁道第三勘察设计院集团有限公司 | Method for uniformly controlling rail plate numerical control grinding machine |
| CN103812392A (en) * | 2012-11-08 | 2014-05-21 | 沈阳新松机器人自动化股份有限公司 | Motor driving controller and dual-motor control method thereof |
| CN106533270A (en) * | 2015-09-09 | 2017-03-22 | 山洋电气株式会社 | Motor control device |
| CN106533270B (en) * | 2015-09-09 | 2021-06-11 | 山洋电气株式会社 | Motor control device |
Also Published As
| Publication number | Publication date |
|---|---|
| CN1299174C (en) | 2007-02-07 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN104714485B (en) | A kind of novel high-precision trace feed servo-system and control method | |
| CN1217248C (en) | Numerical control method | |
| CN101241314B (en) | 6 freedom degrees precision positioning station capable of compensating Z-direction position | |
| CN102085659B (en) | Space-controlled five degree of freedom twelve-rod welding robot mechanism | |
| CN110554659A (en) | large-stroke high-precision micro-nano motion servo feeding system and control method | |
| CN108572576B (en) | Man-machine co-driving and unmanned technology and vehicle-mounted external driving robot for testing | |
| CN101075096A (en) | System for balancing and positioning work table of photoetching device | |
| CN1781662A (en) | Numerical control apparatus and numerical control system | |
| CN1562557A (en) | Elevated platform type automatic processing center of lathe and milling machine of five shafts | |
| CN106737642A (en) | Speed reducing driving device, drive system and control method based on Dual-Servo Motor | |
| CN1529215A (en) | Motor controlling device | |
| CN115268369A (en) | Gantry machine tool movable beam cross coupling control method | |
| CN107791244A (en) | Controller, operation controller, multi-axis actuation control device and drive dynamic control device | |
| CN110161852A (en) | A kind of mobile mechanical arm motion control method based on Second Order Sliding Mode algorithm | |
| CN108762318A (en) | A kind of Multi-axis high-precision closed loop feedback kinetic control system | |
| CN100346369C (en) | Two-dimensional high-performance alternating-current servo CNC experiment system | |
| US20080136362A1 (en) | Drive System | |
| CN1633629A (en) | Servo control method | |
| CN109495025B (en) | Dual-drive gantry platform driving system, method and equipment and computer readable memory | |
| CN104625836A (en) | Numerical control gantry machine tool | |
| CN2703290Y (en) | Full closed-loop AC servo motion control teaching experiment device | |
| CN110340874B (en) | Three-degree-of-freedom parallel driving parallel processing device | |
| CN101666859B (en) | Drive feeding mechanism of dual-linear motor | |
| CN202326958U (en) | Arc and linear movement mechanism | |
| CN217046125U (en) | Unpowered type vehicle body positioning system |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C06 | Publication | ||
| PB01 | Publication | ||
| C10 | Entry into substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| C14 | Grant of patent or utility model | ||
| GR01 | Patent grant | ||
| ASS | Succession or assignment of patent right |
Owner name: ZHEJIANG GUANXI ELECTRIC CO., LTD. Free format text: FORMER OWNER: ZHEJIANG JUNENG HOLDINGS LIMITED Effective date: 20080912 Owner name: ZHEJIANG JUNENG HOLDINGS LIMITED Free format text: FORMER OWNER: HARBIN INSTITUTE OF TECHNOLOGY Effective date: 20080912 |
|
| C41 | Transfer of patent application or patent right or utility model | ||
| TR01 | Transfer of patent right |
Effective date of registration: 20080912 Address after: 4D 63, nine Ring Road, Jianggan District, Zhejiang, Hangzhou: 310019 Patentee after: ZHEJIANG GUANXI ELECTRIC & MOTOR Co.,Ltd. Address before: Hangzhou City, Zhejiang Province, Binjiang District Jiangnan Road No. 3888 Sunyard building seven floor, zip code: 310053 Patentee before: Zhejiang Energy Holdings Ltd. Effective date of registration: 20080912 Address after: Hangzhou City, Zhejiang Province, Binjiang District Jiangnan Road No. 3888 Sunyard building seven floor, zip code: 310053 Patentee after: Zhejiang Energy Holdings Ltd. Address before: No 92, West Da Jie street, Nangang District, Heilongjiang, Harbin: 150001 Patentee before: Harbin Institute of Technology |
|
| EE01 | Entry into force of recordation of patent licensing contract |
Assignee: SHANDONG SHANBO ELECTRIC MACHINE GROUP Co.,Ltd. Assignor: Harbin Institute of Technology Contract fulfillment period: 2009.5.26 to 2014.5.25 Contract record no.: 2009370000109 Denomination of invention: Controller for brushless DC motor of air conditioner Granted publication date: 20070207 License type: Exclusive license Record date: 20090619 |
|
| LIC | Patent licence contract for exploitation submitted for record |
Free format text: EXCLUSIVE LICENSE; TIME LIMIT OF IMPLEMENTING CONTACT: 2009.5.26 TO 2014.5.25; CHANGE OF CONTRACT Name of requester: SHANBO ELECTRIC MACHINE GROUP CO., LTD. Effective date: 20090619 |
|
| C56 | Change in the name or address of the patentee |
Owner name: ZHEJIANG ZHONGKE DERUN TECHNOLOGY CO., LTD. Free format text: FORMER NAME: ZHEJIANG GUANXI ELECTRIC + MOTOR CO., LTD. |
|
| CP01 | Change in the name or title of a patent holder |
Address after: 310019 4D, No. nine, 63 Ring Road, Jianggan District, Zhejiang, Hangzhou Patentee after: ZHEJIANG ZHONGKE DERUN TECHNOLOGY Co.,Ltd. Address before: 310019 4D, No. nine, 63 Ring Road, Jianggan District, Zhejiang, Hangzhou Patentee before: ZHEJIANG GUANXI ELECTRIC & MOTOR Co.,Ltd. |
|
| PE01 | Entry into force of the registration of the contract for pledge of patent right |
Denomination of invention: Controller for brushless DC motor of air conditioner Effective date of registration: 20121130 Granted publication date: 20070207 Pledgee: Zhejiang Xinli Guarantee Service Co.,Ltd. Pledgor: Zhejiang Zhongke Derun Technology Co.,Ltd. Registration number: 2012990000744 |
|
| PLDC | Enforcement, change and cancellation of contracts on pledge of patent right or utility model | ||
| TR01 | Transfer of patent right |
Effective date of registration: 20170817 Address after: Hangzhou City, Zhejiang province Tonglu County 311500 Beach Road No. 73 Patentee after: HANGZHOU SES SERVO MOTOR Co.,Ltd. Address before: 310019 4D, No. nine, 63 Ring Road, Jianggan District, Zhejiang, Hangzhou Patentee before: Zhejiang Zhongke Derun Technology Co.,Ltd. |
|
| TR01 | Transfer of patent right | ||
| CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20070207 Termination date: 20170927 |
|
| CF01 | Termination of patent right due to non-payment of annual fee |