Positioning drive and method for positioning an output element
10700623 · 2020-06-30
Assignee
Inventors
Cpc classification
H02P8/22
ELECTRICITY
F16H55/18
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
H02P5/485
ELECTRICITY
G05B19/404
PHYSICS
H02P8/40
ELECTRICITY
International classification
F16H55/18
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
F16H57/12
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
H02P8/40
ELECTRICITY
Abstract
A positioning drive has a first stepper drive unit having a first stepper drive controller and a first stepper motor, and a second stepper drive unit having a second stepper drive controller and a second stepper drive. The two stepper drives and the power take-off element are force-coupled and drive-coupled by a mechanical coupling unit. A central unit controls the two stepper drive controllers by a control signal, in each instance. The control signals predetermine the stator reference field angle and the rotor reference field angle set by the stepper drive controller. The central unit has an overriding regulator for the position of the power take-off element, and a subordinate regulator for setting a tensioning moment for each stepper motor. The tensioning moments occur by setting a load actual angle at the stepper drive.
Claims
1. Positioning drive (15) for positioning of a power take-off element (16), the drive comprising: a mechanical coupling unit (18) that has a first coupling input (19), a second coupling input (20), and a coupling output (17), wherein the coupling output (17) is connected with the power take-off element (16), a first positioning drive unit (21), which has a first positioning drive (23) connected with the first coupling input (19), and a first positioning drive controller (22) that is set up to control the first positioning drive (23), a second positioning drive unit (24), which has a second positioning drive (26) connected with the second coupling input (20), and a second positioning drive controller (25), which is set up to control the second positioning drive (26), a central unit (31), to which a kinematic reference value (PS) and a tensioning reference value (VS) can be provided, or in which a kinematic reference value (PS) and/or a tensioning reference value (VS) can be determined, wherein the central unit (31) is set up to determine a first control signal (A1) for the first positioning drive controller (22) and a second control signal (A2) for the second positioning drive controller (25), as a function of the kinematic reference value (PS) and the tensioning reference value (VS), wherein the first control signal (A1) and the second control signal (A2) are predetermined in such a manner to generate tensioning moments (M.sub.23, M.sub.26) in opposite directions in the two positioning drives (23, 26), when applied in each instance, wherein the central unit (31) is set up to transmit the first control signal (A1) to the first positioning drive controller (22) and the second control signal (A2) to the second positioning drive controller (25), and wherein the first positioning drive controller (22) is set up to control the first positioning drive (23) as a function of the first control signal (A1) and the second positioning drive controller (25) is set up to control the second positioning drive (26) as a function of the second control signal (A2), so that a tensioning state is generated in the coupling unit (18); wherein both of the first positioning drive (23) and the second positioning drive (26), in the tensioning state, have a first load angle (.sub.i,ist) that results from a difference between a rotor field reference angle (.sub.R23,soll, .sub.R26,soll) and a rotor field actual angle (.sub.R23,ist, .sub.R26,ist); wherein the rotor field reference angle (.sub.R23,soll, .sub.R26,soll) corresponds to a stator field actual angle (.sub.S23,ist, .sub.S26,ist).
2. Positioning drive according to claim 1, wherein the first control signal (A1) describes one or both of a first stator field reference angle (.sub.S23,soll) and a first rotor field reference angle (.sub.R23,soll) for the first positioning drive and the second control signal (A2) describes one or both of a second stator field reference angle (.sub.S26,soll) and a second rotor field reference angle (.sub.R26,soll) for the second positioning drive (26).
3. Positioning drive according to claim 2, wherein the first positioning drive controller (22) is set up to determine a first stepper signal (ST1) for the first positioning drive (23) from the first control signal (A1) and to transmit the first stepper signal (ST1) to the first positioning drive (23), in order to set for the first positioning drive (23) one or both of a first stator field actual angle (.sub.S23,ist) according to the first stator field reference angle (.sub.S23,soll) and a first rotor field actual angle (.sub.R23,ist) according to the first rotor field reference angle (.sub.R23,soll), and wherein the second positioning drive controller (25) is set up to determine a second stepper signal (ST2) for the second positioning drive (26) from the second control signal (A2) and to transmit the second stepper signal (ST2) to the second positioning drive (26), in order to set for the second positioning drive (26) one or both of a second stator field actual angle (.sub.S26,ist) according to the second stator field reference angle (.sub.S26,soll) and a second rotor field actual angle (.sub.R26,ist) according to the second rotor field reference angle (.sub.R26,soll).
4. Positioning drive according to claim 3, wherein the first positioning drive controller (22) is set up to determine a first string current for the first positioning drive (23) as a function of the first stator field reference angle (.sub.S23,soll), and wherein the second positioning drive controller (25) is set up to determine a second string current for the second positioning drive (26) as a function of the second stator field reference angle (.sub.S26,soll).
5. Positioning drive according to claim 4, wherein the first string current and the second string current have a same constant current amplitude value (ID).
6. Positioning drive according to claim 1, wherein the central unit (31) is set up to set the first control signal (A1, A2), in the tensioning state, such that the power take-off element (16) is set up to carry out a sub-step position change (SUB) with a position change amount that is smaller than a position change amount that the first positioning drive (23) can perform outside of the tensioning state, and wherein the central unit (31) is set up to set the second control signal (A2), in the tensioning state, such that the power takeoff element (16) is set up to carry out a sub-step position change (SUB) with a position change amount that is smaller than a position change amount that the second positioning drive (23) can perform outside of the tensioning state.
7. Positioning drive according to claim 6, wherein to carry out a sub-step position change (SUB), stator field actual angles (.sub.S23,ist, .sub.S26,ist) or stator actual angles (.sub.S23,ist, .sub.S26,ist) for the positioning drives (23, 26) are changed alternately.
8. Positioning drive according to claim 1, wherein the rotor field actual angle (.sub.R23,ist, .sub.R26,ist) is determined from a rotor actual angle (.sub.R23,ist, .sub.R26,ist) and a number of pole pairs (pz.sub.i).
9. Positioning drive according to claim 1, wherein a load reference angle (.sub.23,soll, .sub.26,soll) corresponds at most to a maximal load angle (.sub.max) predetermined for one of the first positioning drive (23) or the second positioning drive (26).
10. Positioning drive according to claim 1, wherein the coupling unit (18) is structured without a self-locking effect.
11. Positioning drive according to claim 1, wherein force coupling exists between the coupling inputs (19, 20) and between each coupling input (19, 20) and the coupling output (17).
12. Positioning drive according to claim 1, further comprising a sensor unit (27) in communication with at least one position sensor (28, 29, 30), wherein the sensor unit (27) is configured to generate at least one position signal (P1, P2, P3) that describes a position and/or a position change of the power take-off element (16).
13. Positioning drive according to claim 12, wherein the central unit (31) is set up to process the at least one position signal (P1, P2, P3) and establish a virtual sensor signal (PV1, PV2, PV3) as a function of a last received position signal (P1, P2, P3) and a change value that was determined.
14. Method for positioning of a power take-off element (16) using a positioning drive (15) having a mechanical coupling unit (18) that has a first coupling input (19), a second coupling input (20), and a coupling output (17), wherein the coupling output (17) is connected with the power take-off element (16), having a first positioning drive unit (21), which has a first positioning drive (23) connected with the first coupling input (19) and a first positioning drive controller (22), which is set up for controlling the first positioning drive (23), having a second positioning drive unit (24) that has a second positioning drive (26) drive-connected with the power take-off element (16) and a second positioning drive controller (25), which is set up for controlling the second positioning drive (26), and having a central unit (31), with the method comprising: transmitting a position reference signal (PS) and/or a tensioning reference signal (VS) to the central unit (31) or determining a position reference signal (PS) and/or a tensioning reference signal (VS) by the central unit (31), determining a first control signal (A1) for the first positioning drive controller (22) and a second control signal (A2) for the second positioning drive controller (25), as a function of the position reference signal (PS) and the tensioning reference signal (VS), by the central unit (31), to generate tensioning moments (M.sub.23, M.sub.26) in opposite directions, in each instance, in the two positioning drives (23, 26), transmitting the first control signal (A1) to the first positioning drive controller (22), transmitting the second control signal to the second positioning drive controller, controlling the first positioning drive (23) by the first positioning drive controller (22), as a function of the first control signal (A1) and controlling the second positioning drive (26) by the second positioning drive controller (25), as a function of the second control signal (A2), so that a tensioning state is generated in the coupling unit (17), measuring or estimating rotor field actual values for one or both of the first positioning drive (23) or the second positioning drive (26), using the measured or estimated rotor field actual values to calculate or estimate load angle actual values, and regulating load angle of the one or both of the first positioning drive (23) or the second positioning drive (26) based on the calculated or estimated load angle actual values.
15. Positioning drive (15) for positioning of a power take-off element (16), the drive comprising: a mechanical coupling unit (18) that has a first coupling input (19), a second coupling input (20), and a coupling output (17), wherein the coupling output (17) is connected with the power take-off element (16), a first positioning drive unit (21), which has a first positioning drive (23) connected with the first coupling input (19), and a first positioning drive controller (22) that is set up to control the first positioning drive (23), a second positioning drive unit (24), which has a second positioning drive (26) connected with the second coupling input (20), and a second positioning drive controller (25), which is set up to control the second positioning drive (26), a central unit (31), to which a kinematic reference value (PS) and a tensioning reference value (VS) can be provided, or in which a kinematic reference value (PS) and/or a tensioning reference value (VS) can be determined, wherein the central unit (31) is set up to determine a first control signal (A1) for the first positioning drive controller (22) and a second control signal (A2) for the second positioning drive controller (25), as a function of the kinematic reference value (PS) and the tensioning reference value (VS), wherein the first control signal (A1) and the second control signal (A2) are predetermined in such a manner to generate tensioning moments (M.sub.23, M.sub.26) in opposite directions in the two positioning drives (23, 26), when applied in each instance, wherein the central unit (31) is set up to transmit the first control signal (A1) to the first positioning drive controller (22) and the second control signal (A2) to the second positioning drive controller (25), and wherein the first positioning drive controller (22) is set up to control the first positioning drive (23) as a function of the first control signal (A1) and the second positioning drive controller (25) is set up to control the second positioning drive (26) as a function of the second control signal (A2), so that a tensioning state is generated in the coupling unit (18); wherein the central unit (31) is set up to set the first control signal (A1, A2), in the tensioning state, such that the power take-off element (16) is set up to carry out a sub-step position change (SUB) with a position change amount that is smaller than a position change amount that the first positioning drive (23) can perform outside of the tensioning state, and wherein the central unit (31) is set up to set the second control signal (A2), in the tensioning state, such that the power takeoff element (16) is set up to carry out a sub-step position change (SUB) with a position change amount that is smaller than a position change amount that the second positioning drive (23) can perform outside of the tensioning state; wherein to carry out a sub-step position change (SUB), stator field actual angles (.sub.S23,ist, .sub.S26,ist) or stator actual angles (.sub.S23,ist, .sub.S26,ist) for the positioning drives (23, 26) are changed alternately.
16. Positioning drive (15) for positioning of a power take-off element (16), the drive comprising: a mechanical coupling unit (18) that has a first coupling input (19), a second coupling input (20), and a coupling output (17), wherein the coupling output (17) is connected with the power take-off element (16), a first positioning drive unit (21), which has a first positioning drive (23) connected with the first coupling input (19), and a first positioning drive controller (22) that is set up to control the first positioning drive (23), a second positioning drive unit (24), which has a second positioning drive (26) connected with the second coupling input (20), and a second positioning drive controller (25), which is set up to control the second positioning drive (26), a central unit (31), to which a kinematic reference value (PS) and a tensioning reference value (VS) can be provided, or in which a kinematic reference value (PS) and/or a tensioning reference value (VS) can be determined, wherein the central unit (31) is set up to determine a first control signal (A1) for the first positioning drive controller (22) and a second control signal (A2) for the second positioning drive controller (25), as a function of the kinematic reference value (PS) and the tensioning reference value (VS), wherein the first control signal (A1) and the second control signal (A2) are predetermined in such a manner to generate tensioning moments (M.sub.23, M.sub.26) in opposite directions in the two positioning drives (23, 26), when applied in each instance, wherein the central unit (31) is set up to transmit the first control signal (A1) to the first positioning drive controller (22) and the second control signal (A2) to the second positioning drive controller (25), and wherein the first positioning drive controller (22) is set up to control the first positioning drive (23) as a function of the first control signal (A1) and the second positioning drive controller (25) is set up to control the second positioning drive (26) as a function of the second control signal (A2), so that a tensioning state is generated in the coupling unit (18); wherein the first control signal (A1) describes one or both of a first stator field reference angle (.sub.S23,soll) and a first rotor field reference angle (.sub.R23,soll) for the first positioning drive and the second control signal (A2) describes one or both of a second stator field reference angle (.sub.S26,soll) and a second rotor field reference angle (.sub.R26,soll) for the second positioning drive (26); wherein the first positioning drive controller (22) is set up to determine a first stepper signal (ST1) for the first positioning drive (23) from the first control signal (A1) and to transmit the first stepper signal (ST1) to the first positioning drive (23), in order to set for the first positioning drive (23) one or both of a first stator field actual angle (.sub.S23,ist) according to the first stator field reference angle (.sub.S23,soll) and a first rotor field actual angle (.sub.R23,ist) according to the first rotor field reference angle (.sub.R23,soll), and wherein the second positioning drive controller (25) is set up to determine a second stepper signal (ST2) for the second positioning drive (26) from the second control signal (A2) and to transmit the second stepper signal (ST2) to the second positioning drive (26), in order to set for the second positioning drive (26) one or both of a second stator field actual angle (.sub.S26,ist) according to the second stator field reference angle (.sub.S26,soll) and a second rotor field actual angle (.sub.R26,ist) according to the second rotor field reference angle (.sub.R26,soll); wherein the first positioning drive controller (22) is set up to determine a first string current for the first positioning drive (23) as a function of the first stator field reference angle (.sub.S23,soll), and wherein the second positioning drive controller (25) is set up to determine a second string current for the second positioning drive (26) as a function of the second stator field reference angle (.sub.S26,soll).
17. Positioning drive (15) for positioning of a power take-off element (16), the drive comprising: a mechanical coupling unit (18) that has a first coupling input (19), a second coupling input (20), and a coupling output (17), wherein the coupling output (17) is connected with the power take-off element (16), a first positioning drive unit (21), which has a first positioning drive (23) connected with the first coupling input (19), and a first positioning drive controller (22) that is set up to control the first positioning drive (23), a second positioning drive unit (24), which has a second positioning drive (26) connected with the second coupling input (20), and a second positioning drive controller (25), which is set up to control the second positioning drive (26), a central unit (31), to which a kinematic reference value (PS) and a tensioning reference value (VS) can be provided, or in which a kinematic reference value (PS) and/or a tensioning reference value (VS) can be determined, wherein the central unit (31) is set up to determine a first control signal (A1) for the first positioning drive controller (22) and a second control signal (A2) for the second positioning drive controller (25), as a function of the kinematic reference value (PS) and the tensioning reference value (VS), wherein the first control signal (A1) and the second control signal (A2) are predetermined in such a manner to generate tensioning moments (M.sub.23, M.sub.26) in opposite directions in the two positioning drives (23, 26), when applied in each instance, wherein the central unit (31) is set up to transmit the first control signal (A1) to the first positioning drive controller (22) and the second control signal (A2) to the second positioning drive controller (25), and wherein the first positioning drive controller (22) is set up to control the first positioning drive (23) as a function of the first control signal (A1) and the second positioning drive controller (25) is set up to control the second positioning drive (26) as a function of the second control signal (A2), so that a tensioning state is generated in the coupling unit (18); wherein the central unit (31) is further configured to measure or estimate rotor field actual values for one or both of the first positioning drive (23) or the second positioning drive (26), use the measured or estimated rotor field actual values to calculate or estimate load angle actual values, and effect regulation of load angle of the one or both of the first positioning drive (23) or the second positioning drive (26) based on the calculated or estimated load angle actual values.
18. Positioning drive according to claim 17, wherein both of the first positioning drive (23) and the second positioning drive (26), in the tensioning state, have a first load angle (.sub.i,ist) that results from a difference between a rotor field reference angle (.sub.R23,soll, .sub.R26,soll) and a rotor field actual angle (.sub.R23,ist, .sub.R26,ist).
19. Positioning drive according to claim 18, wherein the rotor field actual angle (.sub.R23,ist, .sub.R26,ist) is determined from a rotor actual angle (.sub.R23,ist, .sub.R26,ist) and a number of pole pairs (pz.sub.i).
20. Positioning drive according to claim 18, wherein a load reference angle (.sub.23,soll, .sub.26,soll) corresponds at most to a maximal load angle (.sub.max) predetermined for one of the first positioning drive (23) or the second positioning drive (26).
21. Positioning drive according to claim 17, wherein the coupling unit (18) is structured without a self-locking effect.
22. Positioning drive according to claim 17, wherein force coupling exists between the coupling inputs (19, 20) and between each coupling input (19, 20) and the coupling output (17).
23. Positioning drive according to claim 17, further comprising a sensor unit (27) in communication with at least one position sensor (28, 29, 30), wherein the sensor unit (27) is configured to generate at least one position signal (P1, P2, P3) that describes a position and/or a position change of the power take-off element (16).
24. Positioning drive according to claim 23, wherein the central unit (31) is set up to process the at least one position signal (P1, P2, P3) and establish a virtual sensor signal (PV1, PV2, PV3) as a function of a last received position signal (P1, P2, P3) and a change value that was determined.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
(1) Advantageous embodiments of the invention are evident from the dependent claims, the description, and the drawing. Below, preferred exemplary embodiments of the invention are described in detail, using the attached drawings. These show:
(2)
(3)
(4)
(5)
(6)
(7)
(8)
(9)
DETAILED DESCRIPTION
(10)
(11) The power take-off element 16 is connected with a coupling output 17 of a mechanical coupling unit 18. The coupling unit 18 is structured, for example, as a gear mechanism, e.g. as a spur gear mechanism or another gear wheel mechanism. It has a first coupling input 19 and a second coupling input 20. Each coupling input 19, 20 is force-coupled with the coupling output 17. Furthermore, in the exemplary embodiment, the two coupling inputs 19, 20 are also force-coupled with one another. As a result, a movement at the coupling output 17, independent of one of the two coupling inputs 19, 20, is not possible.
(12) The positioning drive 15 has a first stepper drive unit 21 having a first stepper drive controller 22 and a first stepper motor 23. The first stepper drive controller 22 generates a first stepper signal ST1 for the first stepper motor 23. The first stepper motor 23 has a stator 23S and a rotor 23R. The rotor 23R is connected with the first coupling input 19.
(13) Analogous to the first stepper drive unit 21, a second stepper drive unit 24 having a second stepper drive controller 25 and a second stepper motor 26 is furthermore present. The second stepper drive controller 25 generates a second stepper signal ST2 for the second stepper motor 26. The second stepper motor 26 has a stator 26S and a rotor 26R, which is connected with the second coupling input 20.
(14) The positioning drive 15 furthermore has a sensor unit 27, which has at least one position sensor. In the exemplary embodiment, a first position sensor 28 is present, which generates a first position signal P1 that describes the position and/or the position change of the power take-off element 16. For example, the first position sensor 28 can be implemented by means of an angle sensor or a different position sensor that measures the current absolute position of the power take-off element 16 and generates a corresponding first position signal P1.
(15) In the exemplary embodiment described here, the sensor unit 27 furthermore has a second position sensor 29 as well as a third position sensor 30. The second and the third position sensor 29, 30 are each assigned to a rotor 23R and 26R, respectively, of a stepper motor and detect its rotational position. The second or third position sensor 29, 30 can be structured as an encoder, for example, and generate a second position signal P2 and a third position signal P3, which describe the rotor actual angle .sub.R23,ist and .sub.R26,ist of the related rotors 23R and 26R, respectively. The second and the third position sensor 29, 30 are optional and serve to perform a subordinate regulation for a respective load angle .sub.23 of the first stepper motor 23 and a load angle .sub.26 of the second stepper motor 26. The load angle .sub.23 or .sub.26 of each stepper motor 23 or 26 results from the difference between a stator field actual angle .sub.Si,ist and the rotor field actual angle .sub.Ri,ist. For the index i, the value i=23 relates to the first stepper motor 23, in each instance, and the index i=26 relates to the second stepper motor 26, in each instance. The stator field actual angle .sub.Si,ist is determined from the known stator field reference angle .sub.Si,soll, and the rotor field actual angle .sub.Ri,ist is determined from the rotor position information of the position signals P2 and P3. Using the first position sensor 28, overriding regulation for the position of the power take-off element 16 is carried out.
(16) In the exemplary embodiment described here, position signals of position sensors are used. Alternatively to this, it is also possible to estimate or calculate the position. For example, a defined starting situation can be produced within the scope of initialization, for example by means of movement against a stop. Proceeding from this starting situation, the stator field changes or stepper pulses can be counted. Based on the information of the transfer factors as well as the numbers of pole pairs of the stepper motors 23, 26, the respective position can then be calculated. This method can optionally be further improved in that gear mechanism play characteristic lines or transfer characteristic lines of the kinematic segment and, if applicable, elasticity values in the kinematic transfer segment are determined and taken into consideration.
(17) The at least one position signal and the three position signals P1, P2, P3, for example, of the sensor unit 27 are transmitted to a central unit 31. The central unit 31 furthermore receives a kinematic reference value, which here is formed by a position reference value PS, as well as a tensioning reference value VS. The position reference value PS defines the reference position of the power take-off element 16, and the tensioning reference value VS describes a mechanical tensioning that is supposed to be applied by the two stepper drive units 21, 24 to the coupling inputs 19, 20 of the coupling unit 18. By means of the tensioning, a play in the mechanical transfer between the coupling inputs 19, 20 and the coupling output 17 and therefore in the kinematic chain between the two rotors 23R, 26R and the power take-off element 16, in particular, can be eliminated. Once the tensioning state has been produced, any existing play is at least reduced, and ideally, it is completely eliminated.
(18) In deviation from the exemplary embodiment described here, a movement default for the power take-off element 16 can also be used as a kinematic reference value here, for example a speed and/or an acceleration and/or a jolt. As a result, an advancing movement, for example, can be controlled or regulated.
(19) Provision of a tensioning reference value is optional. In the central unit 31, a tensioning reference value and thereby a tensioning moment can be determined using a predetermined tensioning strategy or on the basis of empirical values or of a characteristic field, or on the basis of further parameters such as, for example, the speed of rotation of the power take-off element. It is also possible not to provide a tensioning reference value to the central unit 31, but rather to provide a fuzzy reference value such as, for example, off, weak, strong or the like. The tensioning reference value can also be determined in the central unit 31, as described, on the basis of such fuzzy reference values.
(20) As the result of the use of two stepper drive units 21, 24, the positioning drive 15 has two degrees of freedom, by means of which the power take-off element 16 is positioned, for one thing, and for another, the tensioning state can be produced. In the tensioning state, the stepper motors 23, 26 of the stepper drive units 21, 24 each have a load angle .sub.i, thereby producing a motor moment M.sub.i. The motor moments M.sub.i are of equal size, in terms of amount, for example, and have a different direction (
(21) As a function of the kinematic reference value PS and the tensioning reference value VS, the central unit 31 determines a first control signal A1 for the first stepper drive unit 21 and a second control signal A2 for the second stepper drive unit 24. The control signals A1, A2 indicate a position change, in each instance, for the related stepper drive 23 and 26. In this regard, it is indicated by the related control signal A1, A2 for positioning of the power take-off element 16 in what direction the stator field 23S or 26S is supposed to be rotated, and by what amount or by what step number the rotation is supposed to take place. The related control signal A1, A2 can also predetermine a variable that characterizes the stator field intensity, such as, for example, the current amplitude ID.sub.i,soll. Preferably, however, its amount is constant and is not changed during positioning of the power take-off element 16.
(22) According to the invention, a tensioning situation can be produced by way of the kinematic coupling unit 18 as well as the control signals A1, A2 and the stator field variables indicated thereby. This is because the rotor fields cannot follow the stator fields in the tensioning state. As a result, a load angle .sub.i builds up at every stepper motor 23, 26. The control signals A1, A2 can increase the size of the load angles .sub.i of the stepper motors 23, 26, in that they provide opposite direction of rotation defaults for the stator fields in question, or move the power take-off element, in that they provide direction of rotation defaults in the same direction for the stator fields. The central unit 31 is set up for outputting suitable control signals A1, A2 in opposite directions or in the same direction, or also superimpositions of signals in opposite directions or in the same direction, so that not only the overriding position regulation but also the subordinate tensioning regulation or tensioning control is performed. The control signals therefore indicate which load angle .sub.i is supposed to be set at the stepper motors 23, 26, in order to achieve the desired tensioning state.
(23) The stepper drive controllers 22, 25 have no inputs by way of which the motor moment or a motor current that defines the motor moment, particularly an armature transverse current, can be set. The stepper drive controllers 22, 25 merely have inputs at which the amount of a rotational movement of a stator field (in other words the stator field reference angle .sub.i,soll) and/or its direction of rotation and/or its field intensity are set. In this regard, the field intensity is proportional to the current reference amplitude I.sub.Di,soll. The reference currents I.sub.ki,soll for the phases k=1 to n are calculated from the current reference amplitude I.sub.Di,soll and the stator field reference angle .sub.Si,soll.
(24) The stepper motors 23, 26 preferably have a number of pole pairs of at least 25.
(25) The respective stepper drive controller 22 or 25 is set up for setting the actual currents I.sub.ki,ist for the different phases k of the related stepper motor 23 or 26 on the basis of the reference currents I.sub.ki,soll. Each reference current I.sub.ki,soll for a phase is calculated as follows, as a function of the number of phases:
I.sub.ki,soll=ID.sub.i,soll.Math.sin).sub.Si,soll+(k1).Math.90)(1a)
(26) for a stepper motor having n=2 phases, and
(27)
(28) for a stepper motor having n>2 phases.
(29) with: I.sub.ki,soll: reference current for the phase k; ID.sub.i,soll: current amplitude reference value; .sub.Si,soll: stator field reference angle of the stator i; i: is index for the stepper motors 23, 26; k: index for the phases (k=1, 2, . . . n).
(30) In this regard, the following holds true:
I.sub.Di,soll={square root over (.sub.k=1.sup.n(I.sub.ki,soll).sup.2)}(1c)
(31) The current control loop, including the winding inductivities and the winding resistances, can be described using a delay element of the first order. The actual currents I.sub.ki,ist for the phases come out to:
(32)
(33) The time constant is small and therefore Equation (1d) can be simplified as:
I.sub.ki,istI.sub.ki,soll or .sub.si,ist.sub.si,soll.
(34) In
(35) In
(36) The central unit 31 furthermore has a tensioning default block 41, which selects a tensioning strategy and transmits it to a subsequent method block 42 on the basis of the tensioning reference value VS and, if applicable, one or more position signals P1, P2, P3. For selection of the tensioning strategy, the control signals A1, A2 and/or the kinematic reference value PS or other available signals or values can also be transmitted to the tensioning default block 41, in addition or alternatively. For example, as a tensioning strategy at a high speed of rotation of the stepper motors 23, 26 or at a rapid movement of the power take-off element 16, the tensioning can be reduced or eliminated entirely, if the freedom from play of the coupling unit 18 is not important in the case of rapid adjustment. One or more of the following possibilities can be considered as a tensioning strategy, for example: the tensioning reference value VS is predetermined and is maintained unchanged and used to calculate a reference value for the tensioning moment M.sub.V,soll one time; as a function of the tensioning reference value VS and at least one further parameter, such as a position signal P1, P2, P3, a modified tensioning reference value VS and thereby continuously a reference value for the tensioning moment M.sub.V,soll is calculated, on the basis of which a load angle reference value .sub.i,soll for each stepper motor 23, 26 is passed on to the method block 42; as a parameter for calculation of the modified tensioning reference value VS or of the reference value for the tensioning moment M.sub.V,soll, the speed of rotation and/or the acceleration of at least one stepper motor 23, 26 or of the power take-off element 16 can be used, for example.
Depending on the selected tensioning strategy in the tensioning default block 41, a motor reference moment M.sub.i,soll is determined for each stepper drive 23, 26 and thereby a load reference angle .sub.i,soll is determined. In the exemplary embodiment, the motor reference moment M.sub.i,soll is described by means of a load reference angle .sub.i,soll. The relationship between the motor reference moment and the load reference angle can be set as a function of the motor type, for example by a characteristic field, a function or a table. The load reference angle .sub.i,soll defines the respective motor reference moment M.sub.i,soll, which is generated by the related stepper motor 23 or 26. In this regard, the following relationship applies: The load actual angle .sub.i,ist corresponds to the difference between the rotor field actual angle .sub.Ri,ist minus the stator field actual angle .sub.Si,ist,
.sub.i,ist=.sub.Si,ist.sub.Ri,ist(2)
(37) with: .sub.i,ist: load actual angle of the stepper motor i; .sub.Ri,ist: rotor field actual angle of the stepper motor i; .sub.Si,ist: stator field actual angle of the stepper motor i.
(38) Depending on the number of pole pairs of the stepper motor 23, 26, the following relationship exists between the rotor field actual angle .sub.Ri,ist (electrical rotor field angle) and the mechanical rotor actual angle .sub.Ri,ist:
.sub.Ri,ist=.sub.Ri,ist.Math.pz.sub.i(3)
(39) with: .sub.Ri,ist: rotor field actual angle of the stepper motor i; .sub.Ri,ist: mechanical rotor actual angle of the stepper motor i; pz.sub.i: number of pole pairs of the stepper motor i.
(40) A corresponding relationship holds true for the stator field actual angle .sub.Si,ist (electrical stator field actual angle) and the mechanical stator actual angle .sub.si,ist:
.sub.Si,ist=.sub.Si,ist.Math.pz.sub.i(4)
(41) with: .sub.Si,ist: stator field actual angle of the stepper motor i; .sub.Si,ist: stator actual angle of the stepper motor i; pz.sub.i: number of pole pairs of the stepper motor i.
(42) A production-related or assembly-related angle offset .sub.Si,0 for the stator and/or a production-related or assembly-related angle offset .sub.Ri,0 for the stator is ignored in Equations (3) and (4).
.sub.Ri,ist=(.sub.Ri,ist.sub.Ri,0).Math.pz.sub.i(3)
.sub.Si,ist=(.sub.Si,ist.sub.Si,0).Math.pz.sub.i(4)
(43) The angle offsets can be eliminated by means of control technology. They can be determined by means of an initialization process, for example a reference run, or by means of the use of absolute angle transducers.
(44) The respective mechanical rotor actual angle .sub.Ri,ist can be measured, calculated or estimated. In the present case, the mechanical rotor actual angle for the first stepper motor 23 is described by the second position signal P2, and the rotor actual angle of the stepper motor 26 is described by the third position signal P3. In this way, the respective electrical rotor field actual angles can be determined according to Equation (3).
(45) The stator field reference angle .sub.Si,soll is known, since it was output by way of the related output signal A1 or A2, and therefore the stator actual angle .sub.Si,ist is also known, since it was determined in the respective preceding control cycle and therefore can be used for calculation of the stator field actual angle .sub.Si,ist according to Equation (4). Therefore the load actual angle .sub.i,ist can be determined and compared with a load reference angle .sub.i,soll, which is transmitted to the method block 42 by the tensioning default block 41. Accordingly, the method block 42 can determine a change rate on the basis of the deviation between the load reference angle .sub.i,soll and the load actual angle .sub.i,ist, by way of a regulator, which rate is superimposed with the temporal change rate for the rotor field reference angle .sub.Ri,soll, thereby setting the corresponding tensioning moment M.sub.i,ist (
(46) The central unit 31 furthermore has an output block 43. Finally, the control signals A1, A2 for the stepper drive units 21, 24 are determined in the output block 43.
(47) In
(48) In the method block 42, a proportional regulator for load angle control, for example, is used as a regulator. In the method block 42, the stator field reference angle .sub.Si,soll is supplied, which angle approximately corresponds to the stator field actual angle .sub.Si,ist. By means of forming the difference with the rotor field actual angle .sub.Ri,ist, the respective load actual angle .sub.i,ist is obtained. The control deviation between the load reference angle and the load actual angle is transmitted to the load angle regulator 44. The latter generates a first lateral reference change rate d1.sub.i,soll at its output, which rate is superimposed with the reference change rate for the rotor field reference angle .sub.Ri,soll of the position control loop 40 (see
(49) Regulation of the load angle is carried out in a subordinate control loop. For example, the overriding position control loop 40 can regulate the respective rotor actual angle and thereby the position of the power take-off element 16, while the subordinate regulator regulates for the load angle .sub.i or the stator field angle .sub.Si.
(50) For implementation of the regulator, P regulators, PI regulators, PID regulators or the like can be used. By means of setting the regulators for the overriding or the subordinate control loop, a stable overall system can be achieved.
(51) In general, attention must be paid, in the case of the regulators used, that the stepper drives are not overloaded. Therefore it is advantageous if the regulators have manipulated variable restrictions such as speed of rotation restrictions or acceleration restrictions. This is because stepper drives are generally not capable of withstanding overloads, in comparison with servomotors, because generally, the current amplitude is kept constant, and after the maximal load angle has been exceeded, the moment cannot be further increased.
(52) In
(53) The position reference value PS as well as the first position signal P1 are passed to the position control loop 40, and their difference is formed and passed to a position regulator 45. The position regulator outputs a first reference speed of rotation w1.sub.soll. Subsequently, a difference between the first reference speed of rotation w1.sub.soll and a second reference speed of rotation w2.sub.soll is formed and passed to a speed of rotation regulator 46, which outputs a reference speed of rotation change dw.sub.soll for the power take-off element 16. The reference speed of rotation change dw.sub.soll is integrated in an integrator 47, and the second reference speed of rotation w2.sub.soll is formed from this. This second reference speed of rotation w2.sub.soll is subsequently transmitted to a first kinematic model 48 as well as a second kinematic model 49. These form the gear step-ups that might be present in the coupling unit 18, as well as characterizing parameters of the stepper drives, such as the respective number of pole pairs. At the outputs, the change rate d.sub.Ri,soll of the rotor field reference angle .sub.Ri,soll for the respective stepper motor 23 or 26 is determined, output, and transmitted to the method block 42, in each instance.
(54) As illustrated in
(55) In the output block 43 (
(56) The related control signal A1 or A2 is passed to a counter 64, which determines the absolute step number of the related stepper motor 23, 26 from this. From this, in a calculation unit 65, the related stator field reference angle .sub.Si,soll can be determined and transmitted to the method block 42, in each instance.
(57) The load reference angles .sub.i,soll for the stepper motors 23, 26 are determined in the tensioning default block 41 (
(58) Optionally, an additional moment Ma.sub.i,soll corresponding to a desired acceleration value can be added to the tensioning reference moment M.sub.V,soll for each calculation segment ahead of the respective restriction block 71, in order to apply a targeted acceleration moment to the respective stepper drive 23 or 26.
(59) The tensioning state in the coupling unit 18 during positioning when the position of the power take-off element 16 has been reached is illustrated schematically in
(60) The load reference angle .sub.i,soll is restricted to a maximal load angle .sub.max as a function of the type of the stepper motor. In this way, it is ensured that the load reference angle .sub.i,soll is in a range in which the amount of the load moment or motor moment M.sub.i increases with an increasing amount of the load angle actual value .sub.i,ist (
(61) If the positioning drive 15 does not have any position sensors 29, 30 for determining the position of the respective rotor 23R, 26R, a control method can also be used in place of a regulator for the motor moments M.sub.i. For this purpose, the central unit 31 can have an initialization block 50. By way of the initialization block 50, first a defined starting situation is produced. For this purpose, the power take-off element 16 can be moved to a defined zero position, for example; in the case of rotationally driven power take-off elements, this happens preferably once in each direction of rotation. This is particularly carried out individually and separately for both stepper drive units 21, 24. The zero position is detected by a sensor, for example by means of the first position sensor 28. By means of the initialization, a relationship between the rotational movement of each rotor 23S, 26S and the power take-off element 16 is detected and stored in memory. In this regard, gear step-up errors in the mechanical coupling unit 18 can also be corrected. A load reference angle .sub.i,soll can now be set, proceeding from an original rotational position of the rotors 23R, 26R, by means of a predetermined number of rotational steps. Otherwise, the control method corresponds to the regulation described above.
(62) If the second position signal P2 and the third position signal P3 are not available, these two position signals can also be estimated or determined, in the play-free state, using the first position signal P1 as well as depending on the respective gear step-up in the coupling unit 18. The second position signal P2 results from multiplication of the gear step-up i.sub.17,23 between the coupling output 17 and the first stepper motor 23, multiplied by the first position signal P1. The third position signal P3 results, analogous to this, from multiplication of the gear step-up i.sub.17,26 between the coupling output 17 and the second stepper motor 26, multiplied by the first position signal P1. The virtual sensor signals PV2 and PV3 then result from multiplication by the related number of pole pairs.
(63) If the first position signal P1 is also not available, it can also be estimated or determined. With the proviso that the current amplitudes are approximately the same in size and that similar stepper motors are used, the power take-off element 16 will assume an approximately central position, so that the following holds true:
PV1=0,5(PZ.sub.23.Math..sub.S23,ist.Math.i.sub.17,23+PZ.sub.26.Math..sub.S26,ist.Math.i.sub.17,26)(5)
(64) with: PZ.sub.23: number of pole pairs of the first stepper motor 23; PZ.sub.26: number of pole pairs of the second stepper motor 26; i.sub.17,23: gear step-up between coupling output 17 and first stepper motor 23; i.sub.17,26: gear step-up between coupling output 17 and second stepper motor 26.
(65) In this way, ultimately pure control without position signal feedback can be achieved. However, it can also be advantageous to use the first position signal P1 and to merely determine the virtual position signals PV2, PV3. For this purpose, the first position signal P1 or the virtual first position signal PV1 can be used:
PV2=.sub.R23,ist=PV1.Math.PZ.sub.23.Math.i.sub.17,23(6a)
PV3=.sub.R26,ist=PV1.Math.PZ.sub.26.Math.i.sub.17,26(6b)
(66) The possibility of being able to calculate the first position signal P1 in several different ways, alternatively or redundantly, can also be used to recognize a sensor defect and/or to recognize blocking of the drive. Specifically when using stepper motors, this can be relevant, because the stepper motors 23, 26 are not tolerant to overload. Accordingly, suitable measures can be initiated. For example, in the case of a sensor defect in the position determination of the power take-off element 16, it is possible to switch over to emergency control, in which the virtual first position signal PV1 is used instead of the first position signal. In the event of an overload of at least one stepper drive 23, 26, an emergency stop and/or an error signal can be output.
(67) If the sensor signal block 51 is not present, the position signals P1, P2, P3 are used in place of the virtual sensor signals PV1, PV2, PV3 for regulation within the central unit 31.
(68) Using the positioning drive 15, a sub-step position change can furthermore be achieved in the tensioning state. This is particularly relevant if a constant tensioning moment M.sub.V is set and the load reference angles are supposed to remain constant, particularly in the reference position or target position of the power take-off element 16. In this regard, the load angle regulator can be shut off.
(69) A sub-step position change is illustrated schematically in
(70) During adjustment of the stator field actual angle of only one stepper drive unit, the other stepper drive unit will prevent rotation of the power take-off element 16 by the full step amount, and instead will increase both its own load angle and also that of the other stepper drive unit. Only when the other stepper drive unit is also moved one micro-step further (in that the stator field actual angle is correspondingly rotated further) is the power take-off element 16 also rotated further by the full amount, and the load angle of both stepper drive units is reduced once again. In this way, sub-micro-step resolutions can be achieved by means of an alternating step sequence, which resolutions are illustrated here as sub-step position change SUB.
(71) If the two stator angles are now moved sequentially in the same direction of rotation, by one rotational step DS, in each instance, in this way the rotor angle of the two stepper motors and thereby the power take-off element 16 can be moved by the sub-step position change, in each instance, which corresponds to half the rotational step DS, according to the example. This is the case when the gear step-up ratios of the first coupling input 19 to the coupling output 17 and from the second coupling output 20 to the coupling output 17 are equal in size. Different gear step-ups would bring about sub-step position changes that are different in size, depending on whether the stator field of the stepper motor 23 or of the stepper motor 26 is moved by a rotational step DS.
(72) A further possibility for generation of a sub-step position change is illustrated schematically in
(73) If the current amplitude of the stepper drive units 21, 24 is different, then a stator field step of the weaker stepper drive unit brings about a smaller load angle increase at the other stepper drive unit, in each instance, than at itself. In this way, the power take-off element 16 is moved not by half a micro-step, but rather correspondingly less. In such an embodiment, the stepper drive units 21, 24 have different effects on the coupling output 17 of the coupling unit 18, and this can be further reinforced by means of non-linearities in the moment load angle curve of the stepper drive units 21, 24. In this way, step sequences having differently large amounts can also be formed at the coupling output 17.
(74) At first, as in the method for sub-step position change described in connection with
(75) Furthermore, it is possible to further increase the sub-micro-step resolution in that the low-pass behavior on the basis of the mass inertias or of the delayed dynamics of the current control loops of the stepper drive controllers 22, 25 is utilized in targeted manner. In this regard, the central unit 31 generates pulse-width-modulated stepper signals that bring about the result that the respective stepper motor 23, 26 moves by a proportion of the micro-step that corresponds to the duty cycle. In this regard, the frequency of the pulse-width modulation must be sufficiently great so that on the basis of the low-pass behavior, no oscillations are generated at the power take-off element 16.
(76) In
(77) Because all the inputs and outputs of the coupling unit 18 are force-coupled or moment-coupled with one another, the additional setting property of the one excess drive unit that is present (there is one drive unit more than there are coupling outputs) can be used to build up the tensioning in the kinematic chain. However, control in terms of control technology is more complicated. For example, tensioning of five power take-off elements with six drive units would also be conceivable. Preferably, however, each power take-off element 17, 55 possesses two separate drive unit 21, 24 assigned to it, analogous to the representation in
(78) In
(79) In
(80) The method of mechanical coupling between the coupling inputs 19, 20 and the coupling output 17 can be varied in many different ways. Preferably, the coupling unit 18 between the two coupling inputs 19, 20 and the coupling output 17 has no self-locking effect in both directions.
(81) In
(82) In this regard, the following equation can be used.
Ma.sub.i,soll=M.sub.Ri+M.sub.Bi(7)
with:
M.sub.Ri=w2.sub.soll.Math.(i.sub.17,i.Math.K.sub.i.Math.w.sub.Ri,ist.Math.sgn(w.sub.Ri,ist).Math.M.sub.H,i)(8)
M.sub.Bi=dw.sub.soll,ii.sub.17,i.Math.(J.sub.R,i+J.sub.G17,7+0.5.Math.(J.sub.R16,i+J.sub.RL,i))(9)
(83) with: M.sub.Ri friction moment component; w2.sub.soll: second reference speed of rotation; i.sub.17,i: gear step-up between the coupling output 17 and the stepper motor 23 or 26; K.sub.i: friction factor for the stepper motor 23 or 26; w.sub.Ri,ist: actual speed of rotation of the rotor of the stepper motor 23 or 26; M.sub.H,i adhesion friction moment of the stepper motor 23 or 26; dw.sub.soll,i: reference speed of rotation change for the stepper motor 23 or 26; J.sub.R,i: inertia moment of the rotor of the stepper motor 23 or 26; J.sub.G17,i: inertia moment of the coupling unit 18 from the coupling output 17 to the stepper motor 23 or 26; J.sub.R16,i: inertia moment component of the power take-off element with reference to the related stepper motor 23 or 26; J.sub.L,i: inertia moment of the load with reference to the related stepper motor 23 or 26.
(84) The factor 0.5 [in German: 0.5] in Equation (9) indicates that each stepper motor 23, 26 only has to absorb half the acceleration of the drive-related mass inertia moments.
(85) The invention relates to a positioning drive 15 as well as to a method for positioning of a power take-off element 16. The positioning drive 15 has a first stepper drive unit 21 having a first stepper drive controller 22 and a first stepper motor 23, as well as a second stepper drive unit 24 having a second stepper drive controller 25 and a second stepper drive 26. The two stepper drives 23, 26 and the power take-off element 16 are force-coupled and drive-coupled by way of a mechanical coupling unit 18, with the coupling unit 18 having play. A central unit 31 controls the two stepper drive controllers 22, 25 by way of a control signal A1 and A2, respectively. The control signals A1, A2 predetermine the stator field reference angle, in each instance, in such a manner that positioning of the power take-off element takes place, and a load angle occurs in the two stepper motors 23, 26, which angles bring about a tensioning moment that is set by way of the assigned stepper drive controller 22 or 25. The central unit 31 has an overriding regulator for the position of the power take-off element 16. It furthermore has a subordinate controller or regulator for setting motor moments M.sub.23, M.sub.26 in the opposite direction for each stepper motor 23, 26.
REFERENCE SYMBOL LIST
(86) 15 positioning drive 16 power take-off element 17 coupling output 18 coupling unit 19 first coupling input 20 second coupling input 21 first stepper drive unit 22 first stepper drive controller 23 first stepper drive 23R rotor of the first stepper drive 23S stator of the first stepper drive 24 second stepper drive unit 25 second stepper drive controller 26 second stepper drive 26R rotor of the second stepper drive 26S stator of the second stepper drive 27 sensor unit 28 first position sensor 29 second position sensor 30 third position sensor 31 central unit 40 position control loop 41 tensioning default block 42 method block 43 output block 44 load angle regulator 45 position regulator 46 speed of rotation regulator 47 integrator 48 first kinematic model 49 second kinematic model 50 initialization block 51 sensor signal block 54 additional power take-off element 55 additional coupling output 56 third coupling input 57 third stepper drive unit 60 prefix determination unit 61 amount formation unit 62 restriction unit 63 clock generator 64 counter 65 calculation unit 70 function block 71 restriction block 72 first standardization block 73 second standardization block .sub.Ri,ist rotor actual angle .sub.Ri,soll rotor reference angle .sub.i,ist load actual angle .sub.i,soll load reference angle .sub.Ri,ist rotor field actual angle .sub.Ri,soll rotor field reference angle .sub.Si,ist stator field actual angle .sub.Si,soll stator field reference angle d.sub.Ri,soll change rate of the rotor field reference angle d.sub.Si,soll change rate of the stator field reference angle d1.sub.i,soll first temporal reference change rate dw.sub.soll reference speed of rotation change DS rotational step M.sub.23 first tensioning moment of the first stepper motor M.sub.26 second tensioning moment of the second stepper motor Ma.sub.i,soll additional moment PS position reference value P1 first position signal P2 second position signal P3 third position signal ST1 first stepper signal ST2 second stepper signal SUB sub-step position change RI direction pulse TI clock pulse w1.sub.soll first reference speed of rotation w2.sub.soll second reference speed of rotation VS tensioning reference value XP additional parameter