STANDSTILL CONTROL WITH MANIPULATED VARIABLE FEEDFORWARD
20250004440 ยท 2025-01-02
Inventors
Cpc classification
G05B19/358
PHYSICS
International classification
Abstract
In order to specify a method for the standstill control of a drive body on which a friction force acts, by means of which a controlled reduction in undesirably stored potential energy is possible, an activation manipulated variable is specified which changes a setting manipulated variable which does not overcome the friction force to a relaxation manipulated variable, and the relaxation manipulated variable is converted by an actuator into a relaxation drive force acting on the drive body, wherein the activation manipulated variable is specified in such a way that the relaxation drive force overcomes the friction force, acting on the drive body, at least temporarily during the standstill control.
Claims
1. A method for the standstill control of a drive body on which a friction force acts, a setting manipulated variable being determined and converted, utilizing an actuator, into a drive force acting on the drive body in order to bring the drive body to a standstill and/or to keep it at a standstill, wherein a setting manipulated variable is determined for the drive body to be brought to a standstill or for the drive body that has been brought to a standstill or for the drive body that is held at a standstill, which setting manipulated variable alone results in a drive force that does not overcome said friction force, wherein an activation manipulated variable is specified and the determined setting manipulated variable is changed by the activation manipulated variable to a relaxation manipulated variable, and wherein the relaxation manipulated variable is converted, utilizing the actuator, into a relaxation drive force acting on the drive body for moving the drive body, the activation manipulated variable being specified such that the relaxation drive force at least temporarily overcomes the friction force acting on the drive body during the standstill control.
2. The method according to claim 1, wherein the setting manipulated variable is determined utilizing a controller from a deviation between at least one movement variable of the drive body and a standstill set point specified for the at least one movement variable, in order to set the at least one movement variable of the drive body to the specified standstill set point, or wherein the setting manipulated variable is determined utilizing a control system from a standstill set point specified for the at least one movement variable, without taking the at least one movement variable into account when determining the setting manipulated variable.
3. The method according to claim 2, wherein a movement of the drive body resulting from the relaxation drive force leads to a deviation of the at least one movement variable from the standstill set point specified for it, which, during the standstill control, does not exceed a specified maximum deviation of 10% of a value of the specified standstill set point or 5% of a value of the specified standstill set point or 1% of a value of the specified standstill set point or 0.5% of a value of the specified standstill set point.
4. The method according to claim 1, wherein the friction force acting on the drive body is caused by a static friction or a sliding friction or a rolling friction or a combination of the static friction, rolling friction, and sliding friction.
5. The method according to claim 1, wherein the activation manipulated variable is only determined and used to change the setting manipulated variable when the drive body has been held at a standstill for a specified minimum standstill period.
6. The method according to claim 1, wherein the activation manipulated variable is determined in the form of a periodic signal with a specified activation amplitude and/or a specified activation frequency.
7. The method according to claim 1, wherein the activation manipulated variable is used for a specified activation time period to change the setting manipulated variable.
8. The method according to claim 1, wherein a time average value of the activation manipulated variable corresponds to the value zero.
9. The method according to claim 2, wherein a position of the drive body is determined as a movement variable of the drive body, and a target position for the determined position is specified as a standstill set point, or wherein a speed of the drive body is determined as a movement variable of the drive body, and a vanishing target speed for the determined speed is specified as a standstill set point.
10. The method according to claim 2, wherein a position of the drive body is determined as a movement variable of the drive body, and a target position for the determined position is specified as a standstill set point, and wherein the activation manipulated variable is only determined and used to change the setting manipulated variable if a magnitude of a position deviation between the position of the drive body and the specified target position when the drive body is at a standstill is above a specified deviation threshold value.
11. The method according to claim 9, wherein the sign of the activation manipulated variable is selected as a sign opposite to the sign of the position deviation or as a sign corresponding to the sign of the position deviation.
12. The method according to claim 9, wherein the change in the setting manipulated variable by the activation manipulated variable is terminated as soon as the magnitude of the position deviation falls below the specified deviation threshold value.
13. The method according to claim 1, wherein the drive body is mechanically coupled to a number n of further bodies on each of which a friction acts, in particular to a coupling body on which a friction acts, and forms an oscillating multi-body system with at least n resonance frequencies with the number n of further bodies.
14. The method according to claim 13, wherein the activation manipulated variable is specified in the form of a periodic signal with a specified activation amplitude and/or a specified activation frequency, wherein the activation frequency is selected to be greater than the largest of the n resonance frequencies of the resonant multi-body system, or is selected to be greater than or equal to the smallest of the n resonance frequencies of the resonant multi-body system, or equal to one of the n resonance frequencies of the resonant multi-body system, and/or wherein a magnitude of a drive force resulting from a conversion of the relaxation manipulated variable by the actuator overcomes, at least temporarily, a sum of the friction force acting on the drive body and the friction forces acting on the number n of further bodies, which friction forces result from the respective acting frictions.
15. The method according to claim 1, wherein a position and a speed of the drive body in a first coordinate direction are determined as movement variables, and the drive force generated by the actuator acts on the drive body along the first coordinate direction, wherein a second position of the drive body in a second coordinate direction different from the first and a second speed of the drive body along the second coordinate direction are determined as further movement variables, and wherein the activation manipulated variable is only determined and used to change the setting manipulated variable if a magnitude of a second position deviation between the determined second position and a second target position specified for the second position is above a specified second position threshold value.
16. A drive system comprising a movable drive body on which a friction force acts, wherein a control unit, which, in order to control the standstill of the drive body, is configured to determine a setting manipulated variable, and an actuator are provided, the actuator being configured to convert the determined setting manipulated variable into a drive force acting on the drive body in order to bring the drive body to a standstill and/or to keep it at a standstill, wherein the control unit is further configured to determine a setting manipulated variable for the drive body to be brought to a standstill or for the drive body that has been brought to a standstill or for the drive body that is held at a standstill, which setting manipulated variable alone results in a drive force that does not overcome said friction force, wherein the control unit is further configured to specify an activation manipulated variable and to change the determined setting manipulated variable utilizing the activation manipulated variable to a relaxation manipulated variable, and wherein the actuator is further configured to convert the relaxation manipulated variable into a relaxation drive force, acting on the drive body, for moving the drive body, the activation manipulated variable being specified such that the relaxation drive force at least temporarily overcomes the friction force acting on the drive body during the standstill control.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0023] The present disclosure is described in greater detail below with reference to
[0024]
[0025]
[0026]
[0027]
[0028]
[0029]
[0030]
DETAILED DESCRIPTION
[0031]
[0032] It should also be noted that the closed control loop 1 shown in
[0033] A multi-body system MKS as shown in
[0034] In the case shown in
[0035] For the following explanations, it is assumed that a non-negligible friction .sub.1, .sub.2 acts on both the drive body J.sub.A and the coupling body J.sub.K, which in a known manner cause non-negligible friction forces F.sub.r1, F.sub.r2 (possible and sufficiently known friction mechanisms are discussed below with reference to
[0036] Friction can occur for different reasons, so that the frictions .sub.1, .sub.2 considered here can be static friction or sliding friction or rolling friction or a combination of these frictions. For a variety of reasons, the friction .sub.2 acting on the coupling body J.sub.K can be much stronger than the friction .sub.1 acting on the drive body J.sub.A. To illustrate the frictions mentioned, a friction model known from the prior art is shown in
[0037] The frictions .sub.1 and .sub.2 cause friction forces F.sub.r1, F.sub.r2 acting on the bodies in a known manner, e.g., in the case of speed-proportional friction, according to a product of friction and speed (.Math.v), in the case of Coulomb friction .sub.C, according to a product of friction and the sign of the speed (.Math.sign(v)), in the case of static friction, according to a friction force compensating for a drive force, etc. These relationships are well known to a specialist in the field of drive technology (cf., e.g., The Mechatronics Handbook, R. H. Bishop, CRC Press, 2002), so details will not be discussed here.
[0038] With regard to the drive body J.sub.A and the coupling body J.sub.K mechanically coupled to it, it is assumed in the present connection that only the drive body J.sub.A is subjected to a drive force F.sub.A which can be specified by a controller R. This is also in no way mandatory in the context of this disclosure, so that a force specified by a controller R could also act on the coupling body J.sub.K. However, the restriction of drive forces F.sub.A acting only on the drive body J.sub.A facilitates the explanation of the inventive principle in question, since, with a drive force F.sub.A acting only on the drive body J.sub.A, the movement of the coupling body J.sub.K is influenced only by the shaft force F.sub.W transmitted via the mechanical shaft and by the friction .sub.2 acting on the coupling body J.sub.K.
[0039] In the block diagram shown in
[0040] Specifically, in the context of this disclosure, a position x can be measured directly as a movement variable BG, e.g., by a position sensor, which immediately generates a position measurement signal and consequently no longer requires any further processing of a signal generated by a sensor to determine a speed measurement signal. However, a position x can also be determined from another measurement signal, e.g., by integrating a speed signal, or it can be calculated from other signals using the observer technique well known from control engineering, e.g., from measured electrical currents or voltages or from magnetic fluxes, etc. For the present disclosure, it is irrelevant how a processed movement variable BG of a drive body J.sub.A is specifically determined.
[0041] The position x determined as movement variable BG is fed to the controller R in the case shown in
[0042] As is known, in a control loop 1 as shown in
[0043] For practical implementation, a controller, such as a controller R in particular, for controlling a movement variable can be realized on suitable microprocessor-based hardware, which, in some embodiments, forms a control unit, such as, for example, on a microcontroller, or in an integrated circuit (ASIC, FPGA). The prior art also offers a variety of options for an actuator A for converting a setting manipulated variable u.sub.S (information signal) into a drive force F.sub.A (power signal), such as servo motors or electric motors in general (asynchronous motor, synchronous motor, stepper motor), linear motors, hydraulic actuators, etc. As is usual with multi-body systems MKS driven by servo motors, a body of the multi-body system MKS can be a component of the servo motorfor example, its rotor. The aforementioned microprocessor-based hardware for implementing controllers, etc., can also be part of the servo motor and be wired to the aforementioned sensors, encoders, or rotary encoders. These relationships are well known to the person skilled in the art of control and/or drive technology, which is why these specifications are not discussed in more detail at this point.
[0044] In order to explain the problems solved by the present disclosure in more detail,
[0045] If the coupling body J.sub.K of the multi-body system MKS is subjected to a friction .sub.2 that cannot be overcome by the wave force F.sub.W, the coupling body J.sub.K is braked, despite a drive force F.sub.A that is other than zero and despite a wave force F.sub.W that is other than zero, comes to a standstill, and possibly also remains at a standstill. From the perspective of the controller R, which specifies a drive force F.sub.A and only perceives a coupling body J.sub.K that follows this drive force F.sub.A less and less, the coupling body J.sub.K behaves like a body with very high or infinitely high inertia or with very high or infinitely high mass. In this case, the multi-body system MKS can be represented in a first approximation as a constrained single-body system, as shown in
[0046] If the coupling body J.sub.K is subsequently already fixed, while the drive body J.sub.A is still moving, e.g., because it has not yet reached the target position x.sub.soll intended for it, the mechanical shaft connection between the drive body J.sub.A and the coupling body J.sub.K twists. According to Hooke's law, the potential energy E.sub.pot=c.Math.(xx.sub.R).sup.2/2 is stored in the mechanical coupling, or the potential energy E.sub.pot=c.Math.(x.sub.sollx.sub.R).sup.2/2, when the position x has finally reached the specified target position x.sub.soll. In addition to the stored potential energy E.sub.pot, a shaft connection tensioned in this way also involves a shaft restoring force F.sub.W=c.Math.(x.sub.sollx.sub.R) which must be compensated for when the system is at a standstill, since the drive body J.sub.A to be positioned would otherwise move away from the target position x.sub.soll. Corresponding compensation setting manipulated variables, which lead to compensation forces F.sub.S=c.Math.(x.sub.sollx.sub.R) for compensation of a remaining restoring force, are contrary to the intention of energyefficient systems.
[0047] The value of a permanent setting manipulated variable F.sub.S=c.Math.(x.sub.sollx.sub.R) can depend on stationary and dynamic factors, as well as on previous system states, and is therefore usually difficult to model or estimate. In practice, precise modeling often presents the problem that such models are mathematically complex and time-consuming, and therefore real-time use is often not possible. In addition to the problem of oscillations and vibrations described at the beginning, which can result from the dissipation of potential energy E.sub.pot as just described, the restoring forces mentioned are another reason to avoid unnecessarily stored potential energy, which is stored during the shutdown, i.e., the standstill control, of a drive body J.sub.A.
[0048] According to the disclosure, an activation manipulated variable u.sub.akt is provided for this purpose to change the controller manipulated variable u.sub.S, which is explained in more detail below with reference to
[0049] In order to realize a tension-free standstill control, the control circuit shown in
[0050] Since the drive body J.sub.A is brought to a standstill and/or held at a standstill, it usually follows that a setting manipulated variable u.sub.S determined from the specified standstill set point B.sub.soll by the controller R alone only leads to a drive force F.sub.A which no longer overcomes the friction force F.sub.r1 acting on the drive body J.sub.A, i.e., in a known manner no longer overcomes the friction forces resulting from the friction .sub.1 in terms of magnitude. Based on this, in the context of the disclosure, the already mentioned activation manipulated variable u.sub.akt is now specified, and the determined setting manipulated variable u.sub.S is changed by the activation manipulated variable u.sub.akt to a relaxation manipulated variable u.sub.ent. The relaxation manipulated variable u.sub.ent is subsequently converted by the actuator A into a relaxation drive force F.sub.ent, acting on the drive body J.sub.A, to move the stationary drive body J.sub.A, wherein the activation manipulated variable u.sub.akt is specified in such a way that the relaxation drive force F.sub.A at least temporarily overcomes the friction force Fr, acting on the drive body J.sub.A, during the standstill control.
[0051] In the context of this disclosure, changing the setting manipulated variable u.sub.S by the activation manipulated variable u.sub.akt means generating a new manipulated variable, specifically the relaxation manipulated variable u.sub.ent, from the setting manipulated variable u.sub.S and the activation manipulated variable u.sub.akt. For this purpose, the activation manipulated variable u.sub.akt can be added to the setting manipulated variable u.sub.S, as shown in
[0052] The afore-mentioned steps according to the disclosure take place in the embodiment shown in
[0053] It should be noted that it is by no means mandatory to supply all of these quantities to block V. What is crucial is that, in block V, it can be detected whether the drive body J.sub.A is at a standstill or not, or at least is close to reaching a standstill. This can be done, for example, by monitoring whether a speed v.sub.x corresponds to the value zero for a specified duration or is already very low, or by monitoring whether a position corresponds to a target value x.sub.soll for a specified duration, depending on which variables are selected as movement variables.
[0054] By including an activation manipulated variable u.sub.akt, which in conjunction with the setting manipulated variable F.sub.S results in a relaxation drive force F.sub.ent being generated that overcomes the sum of all acting friction forces, it is ensured that there is at least a brief, repeated movement of the bodies J.sub.A, J.sub.K of the multi-body system. This relieves any tension that may exist in the mechanical coupling between the bodies J.sub.A, J.sub.K.
[0055] In some embodiments, suitable control measures are taken to ensure that a movement of the drive body J.sub.A resulting from the relaxation drive force F.sub.ent leads only to a repeated deviation e between the controlled movement variable BG and the standstill set point B.sub.soll specified for it, which, during the standstill control, does not exceed a specified maximum deviation e.sub.max of 10% of a value of the standstill set point B.sub.soll specified during the standstill control, or 5% of a value of the standstill set point B.sub.soll specified during the standstill control, or 1% of a value of the standstill set point B.sub.soll specified during the standstill control, or 0.5% of a value of the standstill set point B.sub.soll specified during the standstill control. A person with average training in control engineering knows which steps can be taken for this purpose, such as a manipulated variable limitation that means that the relaxation manipulated variable F.sub.ent can only slightly overcome the acting friction forces, e.g., that the relaxation manipulated variable F.sub.ent is only 1% or 5% or 10% greater than the acting friction forces.
[0056] In order to avoid having to switch on an activation manipulated variable u.sub.akt every time the drive body J.sub.A is at a standstill, the change of the setting manipulated variable u.sub.S by an activation manipulated variable u.sub.akt can be linked to further conditions. Specifically, in the context of the disclosure and of course in the context of the block diagram shown in
[0057] Possibilities for the concrete design of the activation manipulated variable u.sub.akt according to the disclosure are shown in
[0058] In the curve shown in
[0059] In a particularly advantageous embodiment, an activation amplitude A.sub.F and/or an activation frequency f.sub.F and/or an activation time duration t.sub.add of the activation manipulated variable u.sub.akt, but also other characterizing parameters of an activation manipulated variable u.sub.akt, such as, for example, a ramp gradient in the time course of the activation manipulated variable u.sub.akt, can be changed by means of an adaptation method during the movement of the drive body J.sub.A, wherein different algorithms from the field of adaptive systems can be used, such as least squares methods or maximum likelihood methods or other suitable algorithms. In the same way, a course of an activation manipulated variable u.sub.akt can also be fixed a priori, e.g., by using prior knowledge about occurring friction forces , etc., and the same time course of an activation manipulated variable u.sub.akt can always be used. It is also conceivable to make a selection from a finite number of predefined time courses of an activation manipulated variable u.sub.akt during the standstill control, which can be randomly based or can also depend on the state of the actuator A and/or the drive body J.sub.A. There are various options for specifying or determining the activation manipulated variable u.sub.akt, which a specialist knows how to use appropriately.
[0060] With regard to the choice of the activation frequency f.sub.F, it should be noted that, in the present embodiment, the drive body J.sub.A and the coupling body J.sub.K coupled to the drive body J.sub.A form an oscillating system, which in any case has at least one resonance frequency. In a particularly advantageous manner, care can be taken here to ensure that no resonance frequencies of a given multi-body system MKS are excited, which can be ensured, for example, by choosing the activation frequency f.sub.F to be larger, an in some embodiments, significantly larger, e.g., twice or five times or ten times larger, than the resonance frequency of the oscillating multi-body system MKS. As mentioned earlier, in certain applications, it can also be useful and advantageous to tune the activation frequency f.sub.F exactly to a resonance frequency of the multi-body system MKS and thus to activate it at a resonance point, whereby a given activation amplitude A.sub.F of the activation manipulated variable u.sub.akt achieves the greatest possible effect. A conscious choice between resonance frequencies can also be advantageous, especially in so-called stiff systems whose resonance frequencies are far apart, and where, in this way, the most uniform possible excitation of all bodies of the multi-body system MKS is possible.
[0061] In an advantageous manner, the activation frequency f.sub.F and the activation amplitude A.sub.F of the activation manipulated variable u.sub.akt are chosen such that the multi-body system MKS is not able to completely follow the dynamics of the activation manipulated variable u.sub.akt. The movements generated by the activation manipulated variable u.sub.akt serve exclusively to compensate for tensions in the drive train which are caused by the described frictions .sub.1, .sub.2, such as in particular static friction, usually at the end of a positioning process when stopping. After a short relaxation phase, the additional activation manipulated variable u.sub.akt can be removed again when the system then comes to a standstill.
[0062] In a further advantageous aspect, further quantities shown in
[0063] In a particularly advantageous manner, the change of the setting manipulated variable u.sub.S by the activation manipulated variable u.sub.akt can be terminated as soon as the magnitude of deviation e between the movement variable BG and the standstill set point B.sub.soll falls below the specified deviation threshold value e.sub.min again. Since the disclosure reduces any existing tension and thus allows unnecessary restoring forces to be compensated for, energy can be saved in this way, especially in applications with long downtime phases.
[0064] An important practical application of the present disclosure, which is in particular an application of the disclosure with only a single drive body J.sub.A alone, which is not coupled to any other bodies, is shown below with reference to
[0065] Electrical drive coils L.sub.m1, . . . , L.sub.mn are arranged along the long stator 2 in a known manner for each stator segment Sm in the longitudinal direction (shown in
[0066] In the embodiment of an LLM 1 shown in
[0067] How the present disclosure can be advantageously used in an LLM 10 as shown in
[0068] According to the disclosure, however, in scenario c), after the transport unit T.sub.1 has come to a standstill, an activation manipulated variable u.sub.akt is switched on, whereby the transport unit T.sub.1is set into vibration, the said potential energy is removed from the system by averaging effects, and the tilting in question is resolved. The result of this procedure is scenario d), in which the transport unit T.sub.1 is in the specified target position X.sub.soll in the x-direction xR, but the tilting described is eliminated.
[0069] Since a tilting as described in scenarios a), b), c), and d) of
[0070] Specifically, it may initially be intended to determine a second position y of the drive body J.sub.A in a second coordinate direction yR, which is different from the first coordinate direction, and a second speed v.sub.y of the drive body J.sub.A along the second coordinate direction yR. Based on this, it can be provided that the activation manipulated variable u.sub.akt only be determined and used to change the setting manipulated variable u.sub.S if a magnitude of a second position deviation e.sub.y between the determined second position y and a second target position y.sub.soll specified for the second position y is above a specified second position threshold value y.sub.min, so that, in the present case of the LLM 10 shown in