METHOD OF ESTIMATING AND COMPENSATING INTERFERENCE TORQUE OF LIFTING SYSTEM
20230150793 · 2023-05-18
Inventors
Cpc classification
B66B1/30
PERFORMING OPERATIONS; TRANSPORTING
H02P23/24
ELECTRICITY
B66B1/3476
PERFORMING OPERATIONS; TRANSPORTING
International classification
B66B1/30
PERFORMING OPERATIONS; TRANSPORTING
B66B1/34
PERFORMING OPERATIONS; TRANSPORTING
Abstract
A method of estimating and compensating an interference torque of a lifting system includes steps of: continuously integrating a speed of a motor and specifying an integration value to be zero if the integration value is negative when the elevator car moves upward and downward in a hoist way; estimating a rope load constant of a wire rope according to an initial position and a maximum travel position, and calculating a rope load torque according to the maximum travel position, the rope load constant and a present position of the motor; estimating a car and counterweight load torque according to a car weight of the elevator car and a counterweight weight; estimating an interference torque according to the rope load torque and the car and counterweight load torque, and performing a feedforward compensation to the motor based on the interference torque.
Claims
1. A method of estimating and compensating an interference torque of a lifting system, applied to a motor for driving the lifting system, the motor configured to drive a traction wheel to rotate, and a wire rope across the traction wheel configured to drive an elevator car to move upward and downward in a hoistway, the method of estimating and compensating the interference torque comprising steps of: (a) continuously integrating a speed of the motor and specifying an integration value to be zero if the integration value is negative when the elevator car moves upward and downward between a top and a bottom of the hoistway from an initial position to acquire a maximum travel position of the elevator car in the hoistway, (b) estimating a rope load constant of the wire rope according to the initial position and the maximum travel position when the motor operates at a constant speed, and calculating a rope load torque according to the maximum travel position, the rope load constant, and a present position of the motor, (c) estimating a car and counterweight load torque according to a car weight of the elevator car and a counterweight weight when the motor operates at a zero speed, and (d) estimating an interference torque according to the rope load torque and the car and counterweight load torque, and performing a feedforward compensation to the motor based on the interference torque.
2. The method of estimating and compensating the interference torque as claimed in claim 1, wherein the step (a) comprises steps of: (a1) continuously calculating the integration value when the elevator car moves from the initial position to the top, and specifying the integration value to be zero if the integration value is negative, and (a2) controlling the elevator car to move reversely to the bottom when the elevator car moves to the top, and continuously integrating the integration value, and the integration value acquired by calculating the speed when the elevator car moves from the top to the bottom has a maximum value, and the maximum value is the maximum travel position.
3. The method of estimating and compensating the interference torque as claimed in claim 1, wherein the step (a) comprising steps of: (a1) continuously calculating and updating the integration value when the elevator car moves from the initial position to the bottom, (a2) controlling the elevator car to move reversely to the top when the elevator car moves to the bottom and continuously integrating the integration value, and specifying the integration value to be zero if the integration value is negative, and (a3) controlling the elevator car to move reversely to the bottom when the elevator car moves to the top and continuously integrating the integration value, and the integration value acquired by calculating the speed when the elevator car moves from the top to the bottom has a maximum value, and the maximum value is the maximum travel position.
4. The method of estimating and compensating the interference torque as claimed in claim 1, wherein the step (d) comprising steps of: (d1) estimating the interference torque according to the rope load torque and the car and counterweight load torque, (d2) calculating a compensation torque for the feedforward compensation to the motor according to the interference torque, and (d3) completing the feedforward compensation in a time interval according to the compensation torque under the zero speed control.
5. The method of estimating and compensating the interference torque as claimed in claim 4, wherein the time interval is a difference between the present time and a releasing time of the lifting system; in the step (d3), calculates a compensation current slope according to the compensation torque and the time interval, and completes the feedforward compensation of the compensation torque in the time interval according to the compensation current slope.
6. The method of estimating and compensating an interference torque as claimed in claim 1, wherein the step (d) is performed when the elevator car is empty.
7. The method of estimating and compensating an interference torque as claimed in claim 1, wherein the elevator car further comprises a weight sensor configured to sense a passenger load torque generated by the weight of passengers, wherein in the step (d), estimates the interference torque relative to the motor according to the rope load torque, the car and counterweight load torque, and the passenger load torque.
8. A method of estimating and compensating an interference torque of a lifting system applied to a motor for driving the lifting system, the motor configured to drive a traction wheel to rotate, and a wire rope across the traction wheel configured to drive an elevator car to move upward and downward in a hoistway, the method of estimating and compensating the interference torque comprising steps of: (a) continuously integrating a speed of the motor and performing an absolute value calculation to an integration value if the integration value is negative when the elevator car moves upward and downward between a top and a bottom of the hoistway from an initial position to acquire a maximum travel position of the elevator car in the hoistway, (b) estimating a rope load constant of the wire rope according to the initial position and the maximum travel position when the motor operates at a constant speed, and calculating a rope load torque according to the maximum travel position, the rope load constant, and a present position of the motor, (c) estimating a car and counterweight load torque according to a car weight of the elevator car and a counterweight weight when the motor operates at a zero speed, and (d) estimating an interference torque and performing a feedforward compensation to the motor based on the interference torque according to the rope load torque and the car and counterweight load torque.
9. The method of estimating and compensating the interference torque as claimed in claim 8, wherein the step (a) comprises steps of: (a1) continuously calculating and updating the integration value when the elevator car moves from the initial position to the top, performing the absolute value calculation to the integration value if the integration value is negative, and recording the integration value as an upward position when the elevator car moves to the top, (a2) controlling the elevator car to move reversely to the bottom, starting continuously to calculate and update the integration value when the elevator car moves through the initial position, and recording the integration value as a downward position until the elevator car moves to the bottom, and (a3) acquiring the maximum travel position by according to the sum of the upward position and the downward position.
10. The method of estimating and compensating the interference torque as claimed in claim 8, wherein the step (a) comprises steps of: (a1) continuously calculating and updating the integration value when the elevator car moves downward from the initial position to the bottom, and recording the integration value as a downward position when the elevator car moves to the bottom, (a2) controlling the elevator car to move reversely to the top, starting continuously to calculate and update the integration value when the elevator car moves through the initial position, performing the absolute value calculation to the integration value if the integration value is negative, and recording the integration value as an upward position until the elevator car moves to the top, and (a3) acquiring the maximum travel position by according to the sum of the upward position and the downward position.
11. The method of estimating and compensating the interference torque as claimed in claim 8, wherein the step (d) comprising steps of: (d1) estimating the interference torque according to the rope load torque and the car and counterweight load torque, (d2) calculating a compensation torque for the feedforward compensation to the motor according to the interference torque, and (d3) completing the feedforward compensation in a time interval according to the compensation torque under the zero speed control.
12. The method of estimating and compensating the interference torque as claimed in claim 11, wherein the time interval is a difference between the present time and a releasing time of the lifting system; in the step (d3), calculates a compensation current slope according to the compensation torque and the time interval, and completes the feedforward compensation of the compensation torque in the time interval according to the compensation current slope.
13. The method of estimating and compensating an interference torque as claimed in claim 8, wherein the step (d) is performed when the elevator car is empty.
14. The method of estimating and compensating an interference torque as claimed in claim 8, wherein the elevator car further comprises a weight sensor configured to sense a passenger load torque generated by the weight of passengers, wherein in the step (d), estimates the interference torque relative to the motor according to the rope load torque, the car and counterweight load torque, and the passenger load torque.
Description
BRIEF DESCRIPTION OF DRAWINGS
[0019] The present disclosure can be more fully understood by reading the following detailed description of the embodiment, with reference made to the accompanying drawing as follows:
[0020]
[0021]
[0022]
[0023]
[0024]
[0025]
[0026]
[0027]
[0028]
[0029]
[0030]
[0031]
[0032]
DETAILED DESCRIPTION
[0033] Reference will now be made to the drawing figures to describe the present disclosure in detail. It will be understood that the drawing figures and exemplified embodiments of present disclosure are not limited to the details thereof.
[0034] Please refer to
[0035] As shown in
[0036] Please refer to
[0037] Please refer to
[0038] First, continuously integrating a speed ω.sub.m of the motor and specifying an integration value to be zero if the integration value acquired by integrating the speed ω.sub.m is negative when the elevator car 100 moves upward and downward between a top and a bottom of the hoistway 200 from an initial position θ.sub.a0 to acquire a maximum travel position θ.sub.Max (S11). In other words, the step (S11) is mainly used to acquire the information of the maximum travel position θ.sub.Max of the elevator car in the hoistway 200. The first embodiment of the present disclosure proposes two specific implementations for acquiring the information of the maximum travel position θ.sub.Max, which will be described later. Afterward, estimating a rope load constant of the wire rope according to the initial position θ.sub.a0 and the maximum travel position θ.sub.Max when the motor operates at a constant speed, and calculating a rope load torque relative to the motor according to the maximum travel position θ.sub.Max, the rope load constant, and a present position θ.sub.a of the motor (S12). Afterward, estimating a car and counterweight load torque relative to the motor according to a car weight of the elevator car 100 and a counterweight weight of the counterweight 106 when the motor operates at a zero speed (S13). Finally, estimating an interference torque relative to the motor according to the rope load torque and the car and counterweight load torque, and performing a feedforward compensation to the motor based on the interference torque (S14), wherein this step (S14) can be performed when the elevator car is empty or unloaded. In particular, the steps (S11) to (S14) will be described in detail with the drawings hereinafter.
[0039] Please refer to
[0040] Please refer to
[0041] As mentioned above, the present disclosure is mainly based on the converter for motor control, however the converter cannot acquire the information of the floor where the elevator car 100 is located. Therefore, the maximum travel position θ.sub.Max of the elevator car 100 may only be estimated through information such as the length (distance) of the hoistway 200, the motor speed, etc. Furthermore, since the load torque generated by the difference in the length of the two sides of the wire rope across the traction wheel 102 is related to the position or floor of the elevator car 100, the converter used in the general control method cannot realize the actual position of the elevator car 100 so that the position of the elevator car 100 must be estimated first before estimating and compensating the rope load torque.
[0042] Without considering the rope slip, the move distance of the elevator car 100 is the same as the angle of the traction rotation of the motor, and therefore the estimated value of the position (estimated position) of the elevator car 100 can be acquired by integrating the speed of the motor, expressed as equation (1).
ω.sub.mdt=θ.sub.a+θ.sub.a0 equation (1)
[0043] In which, θ.sub.a is the present position of the elevator car 100, θ.sub.a0 is the initial position of the elevator car 100, and ω.sub.m is the present speed of the motor. Therefore, the estimated position of the elevator car 100 can be acquired by integrating the speed of the motor through equation (1). In other words, there is no need to know the parameter values of the mechanical equipment (such as the wheel diameter of the traction wheel 102, the wheel diameter of the counterweight wheel 104, etc.), and the calculation of conversion from circular motion to linear motion may be omitted.
[0044] In the following, different embodiments for acquiring the maximum travel position θ.sub.Max of the elevator car 100 in the hoistway 200 of the step (S11) will be described.
The First Implement of the First Embodiment
[0045] Please refer to
[0046] Afterward, controlling the elevator car 100 to move in the reverse direction (move reversely) to the bottom of the hoistway 200 and continuously integrating the integration value when the elevator car 100 moves to the bottom, and the integration value acquired by calculating the speed ω.sub.m of the motor when the elevator car 100 moves from the top to the bottom has a maximum value, and the maximum value is the maximum travel position θ.sub.Max of the elevator car 100 moving up and down between the top and the bottom of the hoistway 200.
[0047] Therefore, since the maximum travel distance of the elevator car 100 in the hoistway 200 is fixed, the integral of the motor speed of going back and forth once between the top and the bottom of the hoistway 200 must be zero. Using this feature, when the integral value acquired in the instant calculation is less than zero (negative), the integral value is cleared (that is, the integral value is specified to be zero). Therefore, as long as going back and forth once between the top and the bottom of the hoistway 200, the distance between the position of the elevator car 100 and the top of the hoistway 200 can be eliminated, and the initial position θ.sub.a0 and the maximum travel position θ.sub.Max of the actual elevator car 100 can be acquired.
[0048] As shown in
The Second Implement of the First Embodiment
[0049] Please refer to
[0050] Afterward, controlling the elevator car 100 to move in the reverse direction to the top of the hoistway 200 and continuously integrating the integration value when the elevator car 100 moves to the top, and specifying the integration value to be zero if the integration value is negative during the moving upward process.
[0051] Afterward, controlling the elevator car 100 to move in the reverse direction to the bottom again and continuously integrating the integration value when the elevator car 100 moves to the bottom, and the integration value acquired by calculating the speed ω.sub.m when the elevator car 100 moves from the top to the bottom has a maximum value during the moving downward process, and the maximum value is the maximum travel position θ.sub.Max.
[0052] Therefore, since the maximum travel distance of the elevator car 100 in the hoistway 200 is fixed, the integral of the motor speed of going back and forth once between the top and the bottom of the hoistway 200 must be zero. Using this feature, when the integral value acquired in the instant calculation is less than zero, the integral value is cleared (that is, the integral value is specified to be zero). Therefore, as long as going back and forth once between the top and the bottom of the hoistway 200, the distance between the position of the elevator car 100 and the top of the hoistway 200 can be eliminated, and the initial position θ.sub.a0 and the maximum travel position θ.sub.Max of the actual elevator car 100 can be acquired.
[0053] As shown in
The First Implement of the Second Embodiment
[0054] Please refer to
[0055] Afterward, controlling the elevator car 100 to move in the reverse direction to the bottom, starting to continuously calculate and update the integration value when the elevator car 100 moves through the initial position θ.sub.a0, and recording the integration value as a downward position θ.sub.MAX_d until the elevator car 100 moves downward to the bottom, and finally acquiring the maximum travel position θ.sub.Max by according to the sum of the upward position θ.sub.MAX_u and the downward position θ.sub.MAX_d.
[0056] As shown in
The Second Implement of the Second Embodiment
[0057] Please refer to
[0058] Afterward, controlling the elevator car 100 to move in the reverse direction to the top, starting to continuously calculate and update the integration value when the elevator car 100 moves through the initial position θ.sub.a0, performing the absolute value calculation to the integration value if the integration value is negative, and recording the integration value as an upward position θ.sub.MAX_u until the elevator car 1100 moves to the top, and finally acquiring the maximum travel position θ.sub.Max by according to the sum of the upward position θ.sub.MAX_u and the downward position θ.sub.MAX_d.
[0059] As shown in
[0060] Furthermore, the step (S12) or the step (S22), i.e., estimating the rope load constant of the wire rope according to the initial position θ.sub.a0 and the maximum travel position θ.sub.Max when the motor operates at a constant speed, will be described in detail with hereinafter.
[0061] When considering the change of the length of the wire rope, the motor mechanical motion equation may be expressed in equation (2) as follows.
[0062] In which, J.sub.m is the moment inertia, T.sub.e is the motor output torque, T.sub.p is the load torque generated by passengers, T.sub.c is the load torque generated by the elevator car, T.sub.rc and T.sub.rw are the load torques generated by the change of the wire rope on the car side and the counterweight side, respectively, T.sub.w is the load torque generated by the counterweight, and B.sub.m is the viscous friction coefficient.
[0063] The rope load is related to the position of the elevator car, and expressed as equations (3a) and (3b) as follows.
T.sub.rc=K.sub.rθ.sub.a equation (3a)
T.sub.rw=K.sub.r(θ.sub.Max−θ.sub.a) equation (3b)
[0064] In which, K.sub.r is the rope load constant.
[0065] The equations (3a) and (3b) are substituted into the equation (2) to acquire the equation (4) as follows.
[0066] After simplifying the equation (4), the equation (5) is acquired as follows.
[0067] Since the step (S12) or the step (S22) is to estimate the interference torque of both sides of the wire rope relative to the motor traction when the motor is controlled to rotate at a constant speed, the equation (5) may be rewritten as follows.
0=T.sub.e+T.sub.p+T.sub.c+K.sub.r(2θ.sub.a−θ.sub.Max)−T.sub.w−B.sub.mω.sub.m equation (6)
[0068] After shifting the equation (6), the motor output torque may be acquired as follows.
T.sub.e=−T.sub.p−T.sub.c−K.sub.r(2θ.sub.a−θ.sub.Max)+T.sub.w+B.sub.mω.sub.m equation (7)
[0069] Afterward, the motor output torque is differentiated to the angle, the equation (8) is acquired as follows.
[0070] After shifting the equation (8), the rope load constant is represented as follows.
[0071] Furthermore, the step (S13) or the step (S23), i.e., estimating the car and counterweight load torque relative to the motor according to the car weight of the elevator car and a counterweight weight of the counterweight when the motor operates at a zero speed, and the step (S14) or the step (S24), i.e., estimating the interference torque relative to the motor according to the rope load torque and the car and counterweight load torque, and performing the feedforward compensation to the motor based on the interference torque, will be described in detail with hereinafter.
[0072] Following the equation (5), the torque equation considering the change of the length of the wire rope is represented as follows.
[0073] In which, the sum of the T.sub.c and T.sub.W is the car and counterweight load torque, K.sub.r(2θ.sub.a−θ.sub.Max) is the rope load torque.
[0074] In an empty car (no person riding, that is, T.sub.p=0), when the zero-speed motor control is performed, there is no need to estimate the interference torque caused by the weight of the passengers relative to the motor, and therefore equation (10) may be simplified and rewritten as follows.
0=T.sub.e+T.sub.c+K.sub.r(2θ.sub.a−θ.sub.Max)−T.sub.w equation (11)
[0075] After shifting the equation (11), the car and counterweight load torque is represented as follows.
T.sub.c−T.sub.w=−T.sub.e−K.sub.r(2θ.sub.a−θ.sub.Max) equation (12)
[0076] The estimation of the position of the elevator car with equation (1) may be expressed as follows.
{circumflex over (θ)}.sub.a=∫ω.sub.mdt equation (13)
[0077] The estimation of the rope load torque with equation (9) may be expressed as follows.
[0078] The estimation of the car and counterweight load torque is represented as follows.
{circumflex over (T)}.sub.c−{circumflex over (T)}.sub.w=−T.sub.e−K.sub.r(2θ.sub.a−θ.sub.Max) equation (15)
[0079] In one embodiment, the torque feedforward compensation is set before releasing the brake as follows.
{circumflex over (T)}={circumflex over (T)}.sub.c−{circumflex over (K)}.sub.r(2{circumflex over (θ)}.sub.a−{circumflex over (θ)}.sub.Max)+{circumflex over (T)}.sub.w equation (16)
[0080] The total torque command may be represented as follows.
T.sub.e*=T.sub.ec*+{circumflex over (T)}.sub.D* equation (17)
[0081] The equation (17) for the calculation of the feedforward compensation may be coordinated with the partial block diagram in the upper left part of
[0082] When the estimated value is quite close to the actual value, the equation (18) may be simplified as follows.
[0083] In another embodiment, if the elevator car 100 has a load cell, the weight of the passenger in the elevator car 100 can be accurately estimated and the passenger load torque generated by the passenger weight relative to the motor can be calculated. Therefore, the equation (16) may be rewritten as follows.
{circumflex over (T)}.sub.D=−{circumflex over (T)}.sub.c−{circumflex over (K)}.sub.r(2{circumflex over (θ)}.sub.a−{circumflex over (θ)}.sub.Max)+{circumflex over (T)}.sub.w−T.sub.p equation (20)
[0084] The total torque command may be represented as follows.
[0085] When the estimated value is quite close to the actual value, the equation (21) can be simplified as follows.
[0086] Please refer to
[0087] A current controller receives the current command and a current feedback of a sensed current measured by a current sensor of an inner-loop control loop to generate a voltage command. In particular, the sensed current is converted into the current feedback by a current converter, and the current converter can convert an a-b-c three-phase stationary coordinate to a d-q synchronous rotational coordinate. The voltage command is modulated and processed by a PWM (pulse width modulator) to generate a gate signal to control a converter to drive the motor.
[0088] Accordingly, the present disclosure provides different load torque estimators, including: (i) the estimation of floor or position of the elevator car, (ii) the estimation of the rope load constant for unbalanced load torque at two sides of the wire rope across the traction wheel, and (iii) the estimation for unbalanced load torque between the elevator car and the counterweight. The torque can be estimated before the elevator car is released and the rope length changes on both sides of the traction wheel as the height of the elevator car changes during the traveling process of the wire rope. Therefore, the torque feedforward compensation can be directly performed during the travel process through the rope load estimation so as to reduce the influence of the interference torque on the speed controller. In addition, through the feedforward torque compensation before the brake is released, the noise generated by the instantaneous current change after the brake is released can be effectively reduced, and the passengers' ride feeling can be effectively increased.
[0089] Although the present disclosure has been described with reference to the preferred embodiment thereof, it will be understood that the present disclosure is not limited to the details thereof. Various substitutions and modifications have been suggested in the foregoing description, and others will occur to those of ordinary skill in the art. Therefore, all such substitutions and modifications are intended to be embraced within the scope of the present disclosure as defined in the appended claims.