The present disclosure relates to a method of estimating and compensating an interference torque of a lifting system, and more particularly to a method of estimating and compensating an interference torque of a lifting system according to a rope load torque and a car and counterweight load torque.
The statements in this section merely provide background information related to the present disclosure and do not necessarily constitute prior art.
Electric motors (such as motors) are driven by converters and have been widely used in lifting systems such as elevators, cranes, and warehouses. In order to improve the operation performance of the lifting system, the relevant mechanical parameters of the system are generally used to design a speed controller to meet the performance requirements during operation.
Taking the elevator system as an example, the length of the wire rope, such as steel cable, is also different due to the different floors of the elevator car. When the elevator car is moving, the change in the length of the wire rope across both sides of the traction wheel produces a fluctuating interference torque for the motor and the controller, which affects the control performance and passengers' ride feeling.
An object of the present disclosure is to provide a method of estimating and compensating an interference torque of a lifting system to solve the problems of existing technology.
In order to achieve the above-mentioned object, the method of estimating and compensating the interference torque of the lifting system is applied to a motor for driving the lifting system. The motor drives a traction wheel to rotate, and a wire rope across the traction wheel drives an elevator car to move upward and downward in a hoistway. The method of estimating and compensating the interference torque includes 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.
In one embodiment, the step (a) includes 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.
In one embodiment, the step (a) includes 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.
In one embodiment, the step (d) includes 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.
In one embodiment, 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.
In one embodiment, the step (d) is performed when the elevator car is empty.
In one embodiment, the elevator car further includes a weight sensor, and the weight sensor senses a passenger load torque generated by the weight of passengers. 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.
Another object of the present disclosure is to provide a method of estimating and compensating an interference torque of a lifting system to solve the problems of existing technology.
In order to achieve the above-mentioned object, the method of estimating and compensating the interference torque of the lifting system is applied to a motor for driving the lifting system. The motor drives a traction wheel to rotate, and a wire rope across the traction wheel drives an elevator car to move upward and downward in a hoistway. The method of estimating and compensating the interference torque includes 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.
In one embodiment, the step (a) includes 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.
In one embodiment, the step (a) includes 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.
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 caused by weights 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.
It is to be understood that both the foregoing general description and the following detailed description are exemplary, and are intended to provide further explanation of the present disclosure as claimed. Other advantages and features of the present disclosure will be apparent from the following description, drawings, and claims.
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:
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.
Please refer to
As shown in
Please refer to
Please refer to
First, continuously integrating a speed ωm of the motor and specifying an integration value to be zero if the integration value acquired by integrating the speed ω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 θa0 to acquire a maximum travel position θMax (S11). In other words, the step (S11) is mainly used to acquire the information of the maximum travel position θ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 θMax, which will be described later. Afterward, estimating a rope load constant of the wire rope according to the initial position θa0 and the maximum travel position θ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 θMax, the rope load constant, and a present position θ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.
Please refer to
Please refer to
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 θ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.
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).
ωmdt=θa+θa0 equation (1)
In which, θa is the present position of the elevator car 100, θa0 is the initial position of the elevator car 100, and ω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.
In the following, different embodiments for acquiring the maximum travel position θMax of the elevator car 100 in the hoistway 200 of the step (S11) will be described.
Please refer to
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 ω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 θMax of the elevator car 100 moving up and down between the top and the bottom of the hoistway 200.
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 θa0 and the maximum travel position θMax of the actual elevator car 100 can be acquired.
As shown in
Please refer to
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.
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 ω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 θMax.
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 θa0 and the maximum travel position θMax of the actual elevator car 100 can be acquired.
As shown in
Please refer to
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 θa0, and recording the integration value as a downward position θMAX_d until the elevator car 100 moves downward to the bottom, and finally acquiring the maximum travel position θMax by according to the sum of the upward position θMAX_u and the downward position θMAX_d.
As shown in
Please refer to
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 θ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 θMAX_u until the elevator car 1100 moves to the top, and finally acquiring the maximum travel position θMax by according to the sum of the upward position θMAX_u and the downward position θMAX_d.
As shown in
Furthermore, the step (S12) or the step (S22), i.e., estimating the rope load constant of the wire rope according to the initial position θa0 and the maximum travel position θMax when the motor operates at a constant speed, will be described in detail with hereinafter.
When considering the change of the length of the wire rope, the motor mechanical motion equation may be expressed in equation (2) as follows.
In which, Jm is the moment inertia, Te is the motor output torque, Tp is the load torque generated by passengers, Tc is the load torque generated by the elevator car, Trc and Trw are the load torques generated by the change of the wire rope on the car side and the counterweight side, respectively, Tw is the load torque generated by the counterweight, and Bm is the viscous friction coefficient.
The rope load is related to the position of the elevator car, and expressed as equations (3a) and (3b) as follows.
T
rc
=K
rθa equation (3a)
T
rw
=K
r(θMax−θa) equation (3b)
In which, Kr is the rope load constant.
The equations (3a) and (3b) are substituted into the equation (2) to acquire the equation (4) as follows.
After simplifying the equation (4), the equation (5) is acquired as follows.
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=Te+Tp+Tc+Kr(2θa−θMax)−Tw−Bmωm equation (6)
After shifting the equation (6), the motor output torque may be acquired as follows.
T
e
=−T
p
−T
c
−K
r(2θa−θMax)+Tw+Bmωm equation (7)
Afterward, the motor output torque is differentiated to the angle, the equation (8) is acquired as follows.
After shifting the equation (8), the rope load constant is represented as follows.
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.
Following the equation (5), the torque equation considering the change of the length of the wire rope is represented as follows.
In which, the sum of the Tc and TW is the car and counterweight load torque, Kr(2θa−θMax) is the rope load torque.
In an empty car (no person riding, that is, Tp=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=Te+Tc+Kr(2θa−θMax)−Tw equation (11)
After shifting the equation (11), the car and counterweight load torque is represented as follows.
T
c
−T
w
=−T
e
−K
r(2θa−θMax) equation (12)
The estimation of the position of the elevator car with equation (1) may be expressed as follows.
{circumflex over (θ)}a=∫ωmdt equation (13)
The estimation of the rope load torque with equation (9) may be expressed as follows.
The estimation of the car and counterweight load torque is represented as follows.
{circumflex over (T)}
c
−{circumflex over (T)}
w
=−T
e
−K
r(2θa−θMax) equation (15)
In one embodiment, the torque feedforward compensation is set before releasing the brake as follows.
{circumflex over (T)}={circumflex over (T)}
c
−{circumflex over (K)}
r(2{circumflex over (θ)}a−{circumflex over (θ)}Max)+{circumflex over (T)}w equation (16)
The total torque command may be represented as follows.
T
e
*=T
ec
*+{circumflex over (T)}
D* equation (17)
The equation (17) for the calculation of the feedforward compensation may be coordinated with the partial block diagram in the upper left part of
When the estimated value is quite close to the actual value, the equation (18) may be simplified as follows.
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)}
D
=−{circumflex over (T)}
c
−{circumflex over (K)}
r(2{circumflex over (θ)}a−{circumflex over (θ)}Max)+{circumflex over (T)}w−Tp equation (20)
The total torque command may be represented as follows.
When the estimated value is quite close to the actual value, the equation (21) can be simplified as follows.
Please refer to
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.
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.
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.
Number | Date | Country | Kind |
---|---|---|---|
202111337189.X | Nov 2021 | CN | national |