Assistance arm steel wire rope vibration suppression method and system
By obtaining the wire rope tension and converting it into speed correction value, combined with parameter optimization strategy, the vibration problem caused by changes in wire rope tension during uniform speed is solved, and vibration suppression and operation stability are improved.
Patent Information
- Application Number
- CN202411449087.0
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-10-17
- Publication Date
- 2024-11-29
- Estimated Expiration
- 2044-10-17
AI Technical Summary
In harsh production environments, the jitter and vibration problems caused by changes in the wire rope tension during the uniform lifting and falling speed affect the operating effect.
By obtaining the tension of the wire rope, the tension amplitude calculation strategy is used to convert it into the speed correction value, and the proportional coefficient is adjusted through the parameter optimization strategy, and the speed correction strategy is generated to suppress vibration, including interval scaling, nonlinear function differential and amplification operations to reduce measurement errors and oscillations .
It effectively suppresses the vibration of the assist arm wire rope, improves the running stability and control effect, and reduces data errors and oscillations.
Smart Images

Figure CN119036467A_ABST
Abstract
Description
Technical Field
[0001] The invention belongs to the field of mechanical control, and in particular relates to a method and system for suppressing vibration of a steel wire rope of a booster arm. Background Art
[0002] With the development of intelligent assistive devices (IAD), human-machine cooperation is increasingly used in factories. As a commonly used industrial robot arm, the power-assisted robot arm plays a great auxiliary role in handling industrial products with large volume and weight. The current existing technology has realized the commercial application of power-assisted robot arm related products. However, in actual factory applications, especially in harsh production environments, there are still some problems in the application of power-assisted arms, such as the speed of the power-assisted arm changes too quickly, the heavy object moves upward when it falls to the ground, that is, it bounces off the ground, the detection device is not accurate enough to cause large data errors, and the gear wire rope transmission system will vibrate and affect the operation effect. Among them, during the uniform lifting and lowering process of the power-assisted arm, it will shake due to the change of wire rope tension. Summary of the invention
[0003] In order to solve the shortcomings of the prior art and achieve the purpose of vibration suppression control in the vertical direction of a single degree of freedom, the present invention adopts the following technical solutions:
[0004] A method for suppressing vibration of a steel wire rope of a booster arm comprises the following steps:
[0005] Step 1: Obtain the wire rope tension and convert it into tension amplitude according to the weight of the weight through the tension amplitude calculation strategy;
[0006] Step 2: Through the speed correction strategy, the tension amplitude is converted into a correction value of the speed of the assist arm pulling the wire rope, and the initial speed is superimposed to obtain the speed of the assist arm pulling the wire rope, the speed correction value V cor The formula is as follows:
[0007]
[0008] Wherein, A(t) represents the function of the tension amplitude A based on time t, Kp represents the proportional coefficient, Ki represents the integral coefficient, and A(τ) represents the tension amplitude at time τ;
[0009] Step 3: According to the magnitude of the tension amplitude, a proportional coefficient is generated through a parameter optimization strategy to adjust the speed correction strategy and improve the control effect, including the following steps:
[0010] Step 3.1: Since the Fal function is usually calculated for smaller data, it is necessary to perform interval scaling on the tension amplitude to obtain the error;
[0011] Step 3.2: Differentiate the error through the nonlinear function to obtain the slope of the function;
[0012] Step 3.3: Amplify the slope to generate a corresponding proportional coefficient Kp for adjusting the speed correction strategy.
[0013] Furthermore, in step 1, based on the gross error threshold, the wire rope tension exceeding the threshold is screened out. Due to differences in installation, accuracy, and actual operating conditions, the tension sensor has measurement errors. Directly using the tension data output by the sensor is inaccurate, and the tension amplitude calculation strategy mainly functions to reduce the measurement errors contained in the tension data. Therefore, the gross error threshold can be used to eliminate the gross error, and then multiple averaging operations are performed to obtain the average wire rope tension as the processed tension data for the conversion of the tension amplitude, thereby eliminating random errors.
[0014] Furthermore, in step 1, the formula for converting the tension amplitude through the tension amplitude calculation strategy is as follows:
[0015]
[0016] Among them, A represents the tension amplitude, F' represents the processed tension data, T represents the gravity of the weight, m represents the mass of the weight, and g represents the acceleration of gravity.
[0017] Furthermore, in step 2, a speed correction strategy is constructed based on a digital controller to obtain a discrete control conversion algorithm, and the formula is as follows:
[0018]
[0019] Among them, Kp represents the proportional coefficient, Ki represents the integral coefficient, k represents the discrete moment, n represents the discrete time index, which is each sampling moment in the integral summation process, A(k) represents the tension amplitude at the kth moment, and A(n) represents the tension amplitude at the nth sampling moment.
[0020] Furthermore, in step 2, the assist arm pulls the wire rope through the motor, and the speed correction strategy is the motor speed correction strategy, and the given speed of the motor is obtained by superimposing the speed correction value on the initial speed of the motor.
[0021] Furthermore, the interval scaling operation in step 3.1 is to scale the tension amplitude to the interval [0,1], and the calculation formula is:
[0022]
[0023] Where A represents the tension amplitude, A min Indicates the minimum value of tension amplitude, A maxIndicates the maximum value of the tension amplitude, e_std indicates the value after the tension amplitude A is scaled to the interval [0,1];
[0024] Then scale the e_std value to the target range, and the calculation formula is:
[0025] e'=e_std*(e' max -e min )+e' min
[0026] Among them, e' represents the error after the scaling operation is completed, e' max Indicates the maximum value of the target interval, e' min Indicates the minimum value of the target interval.
[0027] Furthermore, the nonlinear function in step 3.2 is a fal function:
[0028]
[0029] Where e' represents the error, α and δ represent the nonlinearity and nonlinear interval affecting the fal function, respectively, and their values are positive numbers less than 1. sign(·) represents the sign function, and its positive or negative value is judged according to the input value.
[0030] Furthermore, the amplification operation in step 3.3 uses a multi-stage amplification consisting of a nonlinear amplification and a linear amplification connected in series;
[0031] The nonlinear amplification adopts the tanh function method. When the input is positive, the tanh function has a value range of [0,1]. When the input is between [0,1], the function value changes sensitively. When the input is greater than 1, the function value is close to saturation, which can effectively amplify the slope k and suppress the infinite expansion of k. The formula is as follows:
[0032]
[0033] Wherein, k represents the slope of the nonlinear function, f(k) represents the output value of the nonlinear amplification, and e represents the natural logarithm. The linear amplification adopts the multiple method, and the formula is as follows:
[0034] Kp=f(k)*G
[0035] Wherein, f(k) represents the output value of nonlinear amplification, G represents the linear amplification factor, and Kp represents the proportional coefficient.
[0036] A booster arm wire rope vibration suppression system includes a tension sensor and a data processing module. The wire rope tension obtained by the tension sensor is used to control the booster arm to pull the wire rope after the correction speed is obtained by executing a booster arm wire rope vibration suppression method by the data processing module.
[0037] A booster arm includes a steel wire rope and a steel wire rope driving device. The booster arm also includes a steel wire rope vibration suppression system of the booster arm connected to the steel wire rope and the steel wire rope driving device respectively. A correction speed is generated by obtaining the steel wire rope tension, and the steel wire rope driving device is controlled by the correction speed.
[0038] The advantages and beneficial effects of the present invention are:
[0039] The present invention provides a method and system for suppressing vibration of a power-assisting arm wire rope. Through a designed tension amplitude calculation strategy, the tension detected by a tension sensor can be converted into tension amplitude to determine the vibration intensity of the wire rope. Then, through a speed correction strategy, a given speed is corrected to alleviate the vibration problem of the power-assisting arm wire rope. The parameter optimization strategy can adjust the parameters in the speed correction strategy in real time to improve the suppression effect and the stability of the power-assisting arm operation. BRIEF DESCRIPTION OF THE DRAWINGS
[0040] Figure 1 It is a structural block diagram of a vibration suppression method provided by an embodiment of the present invention.
[0041] Figure 2 It is a calculation block diagram of the tension amplitude calculation strategy provided by an embodiment of the present invention.
[0042] Figure 3 It is a calculation block diagram of the speed correction strategy provided by an embodiment of the present invention.
[0043] Figure 4 It is a structural block diagram of a parameter optimization strategy provided by an embodiment of the present invention.
[0044] Figure 5 It is a flow chart of interval scaling provided by an example of the present invention.
[0045] Figure 6 It is a fal function calculation flow chart provided by an example of the present invention.
[0046] Figure 7 It is a numerical amplification flow chart provided by an example of the present invention. DETAILED DESCRIPTION
[0047] The specific implementation of the present invention is described in detail below in conjunction with the accompanying drawings. It should be understood that the specific implementation described here is only used to illustrate and explain the present invention, and is not used to limit the present invention.
[0048] like Figure 1 As shown, a method for suppressing vibration of a wire rope of a booster arm is provided, wherein the input is the tension F detected by the tension sensor, and the output is the given speed V of the motor. During the uniform lifting and lowering process of the booster arm, a tension amplitude calculation strategy is implemented through mathematical calculation, and the tension F measured by the tension sensor at the wire rope is subtracted from the gravity T of the weight to obtain the tension amplitude A generated by the vibration of the wire rope; the tension amplitude A is then converted into a corrected given speed V of the booster arm through a speed correction strategy to achieve vibration suppression of the wire rope tension; the parameter optimization strategy dynamically adjusts the proportional coefficient Kp in the speed correction strategy according to the tension amplitude A to reduce the oscillation in the dynamic process; the specific steps include the following:
[0049] Step 1: Obtain the tension F detected by the tension sensor and convert it into the tension amplitude A through the tension amplitude calculation strategy as the input of the speed correction strategy;
[0050] Due to differences in installation, accuracy, and actual operating conditions, the tension sensor has measurement errors. Directly using the tension data output by the sensor is inaccurate and requires data processing. Figure 2 As shown, the main function of the tension amplitude calculation strategy is to reduce the measurement error contained in the tension data and calculate the tension amplitude A. In order to eliminate gross errors, the wire rope tension F measured by the tension sensor needs to be judged by a threshold. If F exceeds the set threshold, it is determined that F contains gross errors and the data is discarded. If F does not exceed the set threshold, it is determined that F does not contain gross errors and enters subsequent calculations. The setting of the threshold can be adjusted according to the actual measurement situation. In order to eliminate random errors, it is necessary to perform three mean operations on the tension data F that does not contain gross errors to obtain the average value of the tension data, that is, the processed tension data F', and the calculation formula is:
[0051]
[0052] Wherein, F' represents the average value of the tension data, F represents the tension sensor data without gross errors, and i represents the i-th measurement.
[0053] Subtract the tension from the weight of the object to get the tension amplitude, and the calculation formula is:
[0054]
[0055] Among them, A represents the tension amplitude, F' represents the processed tension data, T represents the gravity of the weight, m represents the mass of the weight, and g represents the acceleration of gravity.
[0056] Step 2: Through the speed correction strategy, the tension amplitude A is converted into a correction value of the motor speed, and the initial speed of the motor is superimposed to obtain the given speed V of the motor;
[0057] like Figure 3 As shown, the speed correction value is calculated by the PI algorithm. After the tension amplitude A is adjusted proportionally and integrally, the speed correction value is obtained by superposition. The calculation formula of the PI algorithm is:
[0058]
[0059] Among them, V cor represents the rotation speed correction value, A(t) represents the function of the tension amplitude A based on time t, Kp represents the proportional coefficient, Ki represents the integral coefficient, and A(τ) represents the tension amplitude at time τ.
[0060] Since the algorithm needs to be applied in a digital controller, the control algorithm is converted into discrete form:
[0061]
[0062] Among them, V cor represents the speed correction value, A represents the tension amplitude, Kp represents the proportional coefficient, Ki represents the integral coefficient, k represents the discrete moment, n is the discrete time index, representing each sampling moment in the integral summation process, A(k) represents the tension amplitude at the kth moment, and A(n) represents the tension amplitude at the nth sampling moment.
[0063] After superimposing the speed correction value with the set initial speed value, the given speed V of the motor is obtained. The calculation formula is:
[0064] V=V set +V cor
[0065] Among them, V cor Indicates the speed correction value, V set Indicates the initial value of the speed setting, and V indicates the given speed of the motor.
[0066] Step 3: Through the parameter optimization strategy, according to the size of the tension amplitude A, the parameters in the speed correction strategy are adjusted to improve the control effect;
[0067] In actual control, the PI algorithm with fixed parameters often cannot take into account both stability and good control effect, especially in the motor startup phase, so other control methods need to be used to adjust the parameters. The parameter optimization strategy in the present invention mainly uses the fal function and data reduction and amplification operations to adjust the proportional coefficient Kp in the speed correction strategy, such as Figure 4 As shown in the figure, the strategy includes three steps: interval scaling, fal function calculation, and numerical amplification:
[0068] Step 3.1: Since the fal function usually calculates smaller data, it is necessary to perform interval scaling on the tension amplitude A to obtain the error e', such as Figure 5 As shown. First, scale A to the interval [0,1]. The specific calculation formula is:
[0069]
[0070] Among them, A represents the tension amplitude, Amin represents the minimum tension amplitude, Amax represents the maximum tension amplitude, and e_std represents the value of A scaled to the [0,1] interval.
[0071] Then scale the e_std data to the target range. The specific calculation formula is:
[0072] e'=e_std*(e' max -e min )+e' min
[0073] Among them, e' represents the error after the scaling operation is completed, e' max Indicates the maximum value of the target interval, e' min Represents the minimum value of the target interval, and e_std represents the value of A scaled to the [0,1] interval.
[0074] Step 3.2: The error e' after the scaling operation is completed is used as the input of the fal function. According to the expression of the function, the corresponding function value is calculated. After differentiating the function value, the slope of the function point is obtained, such as Figure 6 shown.
[0075] The fal function is a nonlinear function. It follows the engineering idea of "small error, large gain; large error, small gain". It can keep the system stable during dynamic adjustment and have a better control effect when the system reaches a steady state. From the fal function, it can be understood that when the input is large, the slope is small, and when the input is small, the slope is large. The specific formula of the fal function is:
[0076]
[0077] Where e represents the input error of the function, α and δ represent the nonlinearity and nonlinear interval of the function, and their values are positive numbers less than 1. sign(·) represents the sign function, and its positive or negative value is judged according to the input value.
[0078] Step 3.3: Since the slope of the fal function is small, it is necessary to amplify the slope k to obtain the corresponding value of the proportional coefficient Kp. The amplification operation uses a multi-stage amplification method consisting of nonlinear amplification and linear amplification in series, such as Figure 7As shown. Nonlinear amplification uses the tanh function to amplify, and linear amplification uses the amplification factor to amplify. When the input is positive, the tanh function has a value range of [0,1]. When the input is between [0,1], the function value changes sensitively. When the input is greater than 1, the function value is close to saturation, which can effectively amplify the slope k and suppress the infinite expansion of k. Linear amplification can quickly amplify the slope k to the order of magnitude of Kp in the speed correction strategy.
[0079] The calculation formula for nonlinear amplification is:
[0080]
[0081] Wherein, k represents the slope of the fal function, f(k) represents the output value of the nonlinear amplification, and e represents the natural logarithm.
[0082] The linear amplification formula is:
[0083] Kp=f(k)*G
[0084] Among them, f(k) represents the output value of nonlinear amplification, G represents the linear amplification factor, and Kp represents the proportional coefficient in the speed correction strategy.
[0085] The present invention also relates to a booster arm wire rope vibration suppression system, comprising a tension sensor and a data processing module. The wire rope tension obtained by the tension sensor and the correction speed obtained by the data processing module through executing a booster arm wire rope vibration suppression method are used to control the booster arm to pull the wire rope.
[0086] The present invention also relates to a booster arm, comprising a wire rope and a wire rope driving device. The booster arm also comprises a booster arm wire rope vibration suppression system respectively connected to the wire rope and the wire rope driving device, which generates a correction speed by obtaining the wire rope tension and controls the wire rope driving device with the corrected speed.
[0087] The above embodiments are only used to illustrate the technical solutions of the present invention, rather than to limit the same. Although the present invention has been described in detail with reference to the aforementioned embodiments, those skilled in the art should understand that the technical solutions described in the aforementioned embodiments may still be modified, or some or all of the technical features thereof may be replaced by equivalents. However, these modifications or replacements do not deviate the essence of the corresponding technical solutions from the scope of the technical solutions of the embodiments of the present invention.
Claims
1. A method for suppressing vibration of a steel wire rope of a booster arm, characterized in that The steps include: Step 1: Obtain the wire rope tension and convert it into tension amplitude according to the weight of the weight through the tension amplitude calculation strategy; Step 2: Through the speed correction strategy, the tension amplitude is converted into a correction value of the speed of the assist arm pulling the wire rope, and the initial speed is superimposed to obtain the speed of the assist arm pulling the wire rope, the speed correction value V cor The formula is as follows: Wherein, A(t) represents the function of the tension amplitude A based on time t, Kp represents the proportional coefficient, Ki represents the integral coefficient, and A(τ) represents the tension amplitude at time τ; Step 3: According to the magnitude of the tension amplitude, a proportional coefficient is generated through a parameter optimization strategy to adjust the speed correction strategy, including the following steps: Step 3.1: Perform interval scaling operation on the tension amplitude to obtain the error; Step 3.2: Differentiate the error through the nonlinear function to obtain the slope of the function; Step 3.3: Amplify the slope to generate a corresponding proportional coefficient Kp for adjusting the speed correction strategy.
2. A method for suppressing vibration of a booster arm wire rope according to claim 1, characterized in that: In the step 1, based on the gross error threshold, the wire rope tension exceeding the threshold is screened out, and then multiple averaging operations are performed to obtain the average wire rope tension value as processed tension data for tension amplitude conversion, thereby eliminating random errors.
3. A method for suppressing vibration of a booster arm wire rope according to claim 1, characterized in that: In step 1, the formula for converting the tension amplitude through the tension amplitude calculation strategy is as follows: Among them, A represents the tension amplitude, F' represents the tension data, T represents the gravity of the weight, m represents the mass of the weight, and g represents the acceleration of gravity.
4. A method for suppressing vibration of a booster arm wire rope according to claim 1, characterized in that: In step 2, a speed correction strategy is constructed based on a digital controller to obtain a discrete control conversion algorithm, which is as follows: Where Kp represents the proportional coefficient, Ki represents the integral coefficient, k represents the discrete moment, n represents the discrete time index, A(k) represents the tension amplitude at the kth moment, and A(n) represents the tension amplitude at the nth sampling moment.
5. The method for suppressing vibration of a booster arm wire rope according to claim 1, characterized in that: In step 2, the power-assisting arm pulls the wire rope through the motor, and the speed correction strategy is the speed correction strategy of the motor. The given speed of the motor is obtained by superimposing the speed correction value on the initial speed of the motor.
6. A method for suppressing vibration of a booster arm wire rope according to claim 1, characterized in that: The interval scaling operation in step 3.1 is to scale the tension amplitude to the interval [0,1], and the calculation formula is: Where A represents the tension amplitude, A min Indicates the minimum value of tension amplitude, A max Indicates the maximum value of the tension amplitude, e_std indicates the value after the tension amplitude A is scaled to the interval [0,1]; Then scale the e_std value to the target range, and the calculation formula is: e'=e_std*(e' max -e min )+e' min Among them, e' represents the error after the scaling operation is completed, e' max Indicates the maximum value of the target interval, e' min Indicates the minimum value of the target interval.
7. The method for suppressing vibration of a booster arm wire rope according to claim 1, characterized in that: The nonlinear function in step 3.2 is the fal function: Where e' represents the error, α and δ represent the nonlinearity and nonlinear interval affecting the fal function, respectively, and their values are positive numbers less than 1. sign(·) represents the sign function, and its positive or negative value is judged according to the input value.
8. The method for suppressing vibration of a booster arm wire rope according to claim 1, characterized in that: The amplification operation in step 3.3 uses a multi-stage amplification consisting of a nonlinear amplification and a linear amplification in series; The nonlinear amplification adopts the tanh function method, and the formula is as follows: Wherein, k represents the slope of the nonlinear function, f(k) represents the output value of the nonlinear amplification, and e represents the natural logarithm. The linear amplification adopts the multiple method, and the formula is as follows: Kp=f(k)*G Wherein, f(k) represents the output value of nonlinear amplification, G represents the linear amplification factor, and Kp represents the proportional coefficient.
9. A booster arm wire rope vibration suppression system, comprising a tension sensor and a data processing module, characterized in that: The wire rope tension obtained by the tension sensor is used to control the booster arm to pull the wire rope, and the correction speed obtained by the data processing module through the method for suppressing wire rope vibration of a booster arm as described in claim 1 is used to control the booster arm to pull the wire rope.
10. A booster arm, comprising a steel wire rope and a steel wire rope driving device, characterized in that: The power-assisting arm also includes a power-assisting arm wire rope vibration suppression system as described in claim 9, which is respectively connected to the wire rope and the wire rope driving device, and generates a correction speed by obtaining the wire rope tension, and controls the wire rope driving device with the correction speed.
Citation Information
Patent Citations
Designed method of active disturbance rejection controller based on RBF neural network
CN107037729A
Suppression method and device for longitudinal low-frequency oscillation of steel wire rope of deep well elevator
CN109019277A
Time-frequency cooperative disturbance suppression method and system for rope-driven flexible mechanical arm
CN116038674A
Anti-swing system for steel wire rope of permanent magnet direct drive crane
CN116750647A
Rope-driven space manipulator modeling test method and system
CN117245670A
