Self-adaptive vibration suppression method, vibration suppression system and robot thereof

Through the adaptive vibration suppression method, the PID control parameters are calculated using the LabVIEW data processing system and the fuzzy control module, and the electromagnetic damping vibration absorber is controlled in real time, which solves the vibration problem during high-speed movement of the robot arm and improves product quality and operating efficiency.

CN118927236APending Publication Date: 2024-11-12CHANGZHOU UNIV
View PDF 0 Cites 1 Cited by

Patent Information

Application Number
CN202410969031.1
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-19
Publication Date
2024-11-12

AI Technical Summary

Technical Problem

When the robotic arm moves at high speed, vibration problems are prone to occur due to the structural characteristics of joint components, resulting in a decrease in trajectory accuracy and positioning efficiency, which affects processing quality and working efficiency.

Method used

Adaptive vibration suppression method is adopted to collect vibration displacement signals in real time through displacement sensors, calculate PID control parameters using LabVIEW data processing system and fuzzy control module, and control it in real time through electromagnetic damping vibration absorber to suppress the vibration of the robotic arm.

Benefits of technology

It realizes efficient suppression of vibration during high-speed movement of the robot arm, improves product quality and operating efficiency, and simplifies the adjustment process.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118927236A_ABST
    Figure CN118927236A_ABST
Patent Text Reader

Abstract

The invention relates to the technical field of vibration detection, in particular to a self-adaptive vibration suppression method, a vibration suppression system and a robot thereof. The method comprises the following steps: collecting a vibration displacement signal on a core shaft of the electromagnetic damping vibration absorber in real time through a displacement sensor, and preprocessing the vibration displacement signal; a vibration displacement signal is obtained and processed through a LabVIEW data processing system, and amplitude information and frequency information of the vibration displacement signal are obtained through calculation; transmitting the amplitude information and the frequency information to a fuzzy control module for processing to obtain an optimal PID control parameter; the PID controller obtains an optimal PID control parameter, outputs a vibration suppression parameter after processing based on a set fuzzy control strategy, outputs a corresponding working current after processing the vibration suppression parameter through the power amplifier, and transmits the working current to the electromagnetic damping vibration absorber so as to control the current of a coil winding in the electromagnetic damping vibration absorber. Real-time control over the electromagnetic force of the electromagnetic damping vibration absorber is achieved, then vibration of the mechanical arm in the working process is restrained, and the product quality and the working efficiency are improved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of vibration detection technology, and in particular to an adaptive vibration suppression method, a vibration suppression system and a robot thereof. Background Art

[0002] Robots are mechanical equipment used in the industrial field, and robotic arms are the most widely used automated mechanical devices in the field of robotic technology. Multi-joint robotic arms or multi-degree-of-freedom mechanical devices are widely used in industries such as electronics, logistics, and chemicals, realizing automation and efficiency improvement in the production process. However, due to the structural design characteristics of robotic arms, especially the use of RV reducers, harmonic reducers, or synchronous belts as transmission elements in joint components, and the control system often assumes rigid transmission for control, robotic arms often face vibration problems during high-speed movement, especially during high-speed start-stop stages.

[0003] The robot arm consists of a base, connecting rods and joint components. The compact structure of the joints causes the end vibration to be transmitted to each joint and the base, which has an adverse effect on the trajectory accuracy and positioning efficiency. This vibration phenomenon is particularly obvious in high-speed movement, which may lead to reduced processing quality and operating efficiency. Therefore, studying the vibration suppression technology of industrial robot arms is of great significance to improving the operating performance of robots. Summary of the invention

[0004] The present invention aims to solve at least one of the technical problems existing in the prior art.

[0005] To this end, the present invention provides an adaptive vibration suppression method, a vibration suppression system and a robot thereof, which can suppress the vibration of a robot arm during high-speed movement, thereby improving product quality and operating efficiency.

[0006] According to an adaptive vibration suppression method according to an embodiment of the present invention, the method comprises the following steps:

[0007] S1, real-time acquisition of vibration displacement signals on the core shaft of the electromagnetic damping vibration absorber through the displacement sensor And the vibration displacement signal Pretreatment;

[0008] S2, acquiring and processing the vibration displacement signal through the LabVIEW data processing system The vibration displacement signal is calculated The amplitude A, amplitude B and frequency ω n ;

[0009] S3, the amplitude A, amplitude B and frequency ω n Transmitted to the fuzzy control module for processing, the optimal PID control parameter K is obtained P , K I , KD ;

[0010] S4, the PID controller obtains the optimal PID control parameter K P , K I , K D , and outputs vibration suppression parameters after processing based on the set fuzzy control strategy. The vibration suppression parameters are processed by the power amplifier to output corresponding working currents, and the working currents are transmitted to the electromagnetic damping vibration absorber to control the current of the coil winding in the electromagnetic damping vibration absorber, thereby realizing real-time control of the electromagnetic force of the electromagnetic damping vibration absorber, and thus suppressing the vibration of the robot arm during operation.

[0011] The beneficial effect of the present invention is that the adaptive vibration suppression method of the present invention combines the LabVIEW data processing system and the fuzzy control module, the LabVIEW data processing system acquires the real-time vibration amplitude and frequency information of the vibration signal online, the former has a simple structure, the fuzzy control module has good robustness and adjustable parameters, and the PID controller and the power abandonment are coordinated to realize adaptive vibration control, which has a highly efficient vibration suppression effect, the vibration suppression method is simple and easy to adjust, and can suppress the vibration of the robot arm during high-speed movement, thereby improving product quality and operation efficiency.

[0012] According to one embodiment of the present invention, in step S1, the vibration displacement signal De-noising filtering is performed based on an infinite impulse response (IIR) filter.

[0013] According to one embodiment of the present invention, step S3 specifically includes the following steps:

[0014] Get the amplitude A, the amplitude B and the frequency ω n ;

[0015] The amplitude A, the amplitude B and the frequency ω n Compare with the preset values ​​to obtain the current displacement error e;

[0016] Calculate the change rate E between the current displacement error e and the previous displacement error;

[0017] Based on the current displacement error e and the change rate E, a preset fuzzy rule is queried in the fuzzy set domain to obtain a PID correction parameter in the fuzzy set domain;

[0018] The PID correction parameters are defuzzified using the triangular membership function to obtain the optimal PID control parameter K P , K I , K D .

[0019] According to one embodiment of the present invention, in step S4, when the electromagnetic force of the electromagnetic damping vibration absorber is controlled in real time, the natural frequency of the electromagnetic damping vibration absorber is made equal to the external interference frequency, and the thrust plate of the electromagnetic damping vibration absorber is controlled to be in the middle position to absorb the vibration caused by the execution end of the robot arm.

[0020] According to one embodiment of the present invention, in step S4, the formula of the electromagnetic force F of the electromagnetic damping vibration absorber is expressed as:

[0021] F = k i i+k x x

[0022] Among them, k i , k x is the current stiffness and displacement stiffness coefficient, x is the displacement distance of the electromagnetic damping vibration absorber core shaft, and i is the working current;

[0023] According to Newton's law, the kinematic equation of the thrust plate of the electromagnetic damping vibration absorber is expressed as:

[0024]

[0025] Wherein, m is the total mass of the thrust plate and the mandrel;

[0026] From the Laplace transform we get:

[0027]

[0028] By controlling the thrust plate through the PID controller, the relationship between the equivalent stiffness and equivalent damping of the corresponding electromagnetic damping vibration absorber and the PID control parameters is expressed as follows:

[0029]

[0030] Among them, k w , k g are the displacement gain coefficient and the power amplifier gain coefficient, and T is the low-pass filter coefficient of the PID controller;

[0031] When the electromagnetic damping absorber is working, the natural frequency of the absorber is n When the frequency ω of the external disturbance is kept consistent, the purpose of absorbing vibration is achieved, that is, it satisfies:

[0032]

[0033] Based on the optimal PID control parameter K P , K I , K D Changing the equivalent stiffness and damping changes the natural frequency ω of the vibration absorber n, to absorb vibrations of different frequencies at the end of the robot arm.

[0034] According to an embodiment of the present invention, an adaptive vibration suppression system adopts the adaptive vibration suppression method as described above, and the system includes:

[0035] An electromagnetic damping vibration absorber, mounted on the base of the robot arm;

[0036] A displacement sensor is installed on the electromagnetic damping vibration absorber and is configured to collect the vibration displacement signal on the core shaft of the electromagnetic damping vibration absorber in real time. And the vibration displacement signal Pretreatment;

[0037] A LabVIEW data processing system is configured to acquire and process the vibration displacement signal The vibration displacement signal is calculated The amplitude A, amplitude B and frequency ω n ;

[0038] A fuzzy control module is configured to obtain and process the amplitude A, amplitude B and frequency ω n , get the optimal PID control parameter K P , K I , K D

[0039] A PID controller is configured to obtain the optimal PID control parameter K P , K I , K D , and outputs vibration suppression parameters after processing based on the set fuzzy control strategy. The vibration suppression parameters are processed by the power amplifier to output corresponding working currents, and the working currents are transmitted to the electromagnetic damping vibration absorber to control the current of the coil winding in the electromagnetic damping vibration absorber, thereby realizing real-time control of the electromagnetic force of the electromagnetic damping vibration absorber, and thus suppressing the vibration of the robot arm during operation.

[0040] According to one embodiment of the present invention, the electromagnetic damping vibration absorber includes: a cylindrical shell, the top of the cylindrical shell is an upper end cover of the shell, the bottom is a lower end cover of the shell, a core shaft is arranged at the axial position of the cylindrical shell, the core shaft passes through the upper end cover of the shell and the lower end cover of the shell, and a first coil, a pushing disk and a second coil are arranged on the core shaft in sequence.

[0041] According to one embodiment of the present invention, the displacement sensor is mounted on the core shaft.

[0042] A robot according to an embodiment of the present invention includes the adaptive vibration suppression system as described above.

[0043] Other features and advantages of the present invention will be described in the following description, and partly become apparent from the description, or understood by practicing the present invention. The purpose and other advantages of the present invention are realized and obtained by the structures particularly pointed out in the description, claims and drawings.

[0044] In order to make the above-mentioned objects, features and advantages of the present invention more obvious and easy to understand, preferred embodiments are given below and described in detail with reference to the accompanying drawings. BRIEF DESCRIPTION OF THE DRAWINGS

[0045] The present invention is further described below in conjunction with the accompanying drawings and embodiments.

[0046] Figure 1 is a flow chart of a method according to Embodiment 1 of the present invention;

[0047] Figure 2 This is a schematic diagram of the connection between an electromagnetic damping vibration absorber and a robot arm according to an embodiment of the present invention;

[0048] Figure 3 is the input simulated disturbance displacement signal in the present invention;

[0049] Figure 4 It is the vibration suppression simulation result based on the electromagnetic damping vibration absorber in the present invention.

[0050] Figure 5 It is a structural schematic diagram of Embodiment 2 of the present invention;

[0051] Figure 6 is a cross-sectional view of the electromagnetic damping vibration absorber of the present invention;

[0052] Figure 7 It is a schematic diagram of the internal cross-sectional structure of the electromagnetic damping vibration absorber in the present invention;

[0053] In the figure: 1. electromagnetic damping vibration absorber; 2. displacement sensor; 3. power amplifier; 4. fuzzy control module; 5. PID controller; 11. cylindrical shell; 12. core shaft; 121. first coil; 122. push plate; 123. second coil. DETAILED DESCRIPTION

[0054] The present invention will now be described in further detail with reference to the accompanying drawings. These drawings are simplified schematic diagrams, which only illustrate the basic structure of the present invention in a schematic manner, and therefore only show the components related to the present invention.

[0055] Example 1

[0056] The present invention provides an adaptive vibration suppression method, which includes the following steps:

[0057] S1, real-time acquisition of vibration displacement signals on the core shaft 12 of the electromagnetic damping vibration absorber 1 through the displacement sensor 2 And the vibration displacement signal Pretreatment;

[0058] S2, obtain and process the vibration displacement signal through LabVIEW data processing system 3 Calculate the vibration displacement signal The amplitude A, amplitude B and frequency ω n ;

[0059] S3, the amplitude A, amplitude B and frequency ω n Transmitted to the fuzzy control module 4 for processing, the optimal PID control parameter K is obtained P , K I , K D ;

[0060] S4, PID controller 5 obtains the optimal PID control parameter K P , K I , K D , and outputs the vibration suppression parameters after processing based on the set fuzzy control strategy. The vibration suppression parameters are processed by the power amplifier 3 to output the corresponding working current, and the working current is transmitted to the electromagnetic damping vibration absorber 1 to control the current of the coil winding in the electromagnetic damping vibration absorber 1, so as to realize real-time control of the electromagnetic force of the electromagnetic damping vibration absorber 1, thereby suppressing the vibration of the robot arm during operation.

[0061] In the embodiment, in step S1, the vibration displacement signal De-noising filtering based on infinite impulse response (IIR) filters ensures accurate and reliable vibration displacement signals in subsequent vibration suppression and control There are often various interference sources in the machine working environment, such as electromagnetic interference, mechanical noise, etc. The use of appropriate noise reduction technology, such as infinite impulse response (IIR) filtering, can effectively remove electromagnetic interference and mechanical noise interference and extract accurate and effective vibration displacement signals. This helps ensure that subsequent vibration analysis and control are based on accurate vibration data, improving the accuracy of adaptive vibration suppression control. Further, based on the infinite impulse response (IIR) filter, it is expressed as:

[0062]

[0063] Where ρ is the polar radius, a = -2cosω, and ω is the notch frequency. When the IIR filter converges, a→a0 = -2cosω0, that is, ω→ω0, and the notch frequency is equal to the input signal frequency ω0, completing the adaptive filtering of the noise.

[0064] In the embodiment, in step S2, the LabVIEW data processing system 3 can collect and process data online and monitor the operation status of the equipment in real time. The LabVIEW data processing system 3 provides a wealth of signal processing functions and tools to process the collected vibration displacement signal. Filtering, Fourier transform, etc., among which, the vibration displacement signal Fourier transform obtains the amplitude and frequency information of the signal. The extracted real-time amplitude and frequency information are input into the fuzzy control module for processing.

[0065] In an embodiment, step S3 specifically includes the following steps:

[0066] Get amplitude A, amplitude B and frequency ω n ;

[0067] The amplitude A, amplitude B and frequency ω n Compare with the preset values ​​to obtain the current displacement error e;

[0068] Calculate the change rate E between the current displacement error e and the previous displacement error;

[0069] Based on the current displacement error e and the rate of change E, a preset fuzzy rule is queried in the fuzzy set domain to obtain a PID correction parameter in the fuzzy set domain;

[0070] The triangle membership function is used to defuzzify the PID correction parameters and obtain the optimal PID control parameter K P , K I , K D .

[0071] It should be noted that the fuzzy set domain is set in advance, and then the preset fuzzy rules are queried in the fuzzy set domain according to the current displacement error e and the change rate E, and the PID correction parameters in the fuzzy set domain are automatically obtained. Finally, the PID correction parameters are defuzzified to obtain the optimal PID control parameter K P , K I , K D , so that the PID controller can more accurately control the electromagnetic force of the electromagnetic damping vibration absorber 1 in real time in the subsequent steps.

[0072] In the embodiment, in step S4, when the electromagnetic force of the electromagnetic damping vibration absorber 1 is controlled in real time, the natural frequency of the electromagnetic damping vibration absorber 1 is made equal to the external interference frequency, and the thrust plate of the electromagnetic damping vibration absorber 1 is controlled to be in the middle position to absorb the vibration caused by the execution end of the robot arm, and effectively suppress the reverse exciting force generated by the end of the robot arm when it is working, such as drilling, so as to minimize the vibration impact during the working process.

[0073] Furthermore, the formula of the electromagnetic force F of the electromagnetic damping vibration absorber 1 is expressed as:

[0074] F = k i i+k x x

[0075] Among them, k i , k x is the current stiffness and displacement stiffness coefficient, x is the displacement distance of the core shaft 12 of the electromagnetic damping vibration absorber 1, i is the working current, and the displacement distance of the core shaft 12 of the electromagnetic damping vibration absorber 1 is the distance that the electromagnetic damping vibration absorber causes the core shaft to move axially (downward) according to the exciting force transmitted from the outside.

[0076] The vibration of the base caused by the reaction force of the robot can be analogized to a spring-mass-damper mechanical displacement system. According to Newton's law, the kinematic equation of the thrust plate of the electromagnetic damping vibration absorber 1 is expressed as:

[0077]

[0078] Wherein, m is the total mass of the thrust plate and the mandrel 12;

[0079] From the Laplace transform we get:

[0080]

[0081] By controlling the thrust plate through the PID controller 5, the relationship between the equivalent stiffness and equivalent damping of the corresponding electromagnetic damping vibration absorber 1 and the PID control parameters is expressed as follows:

[0082]

[0083] Among them, k w , k g is the displacement gain coefficient and the power amplifier 3 gain coefficient, T is the low-pass filter coefficient of the PID controller 5;

[0084] When the electromagnetic damping vibration absorber 1 is working, the natural frequency of the vibration absorber ω n When the frequency ω of the external disturbance is kept consistent, the purpose of absorbing vibration is achieved, that is, it satisfies:

[0085]

[0086] When the electromagnetic damping vibration absorber 1 is working, based on the optimal PID control parameter K P , K I , K D Changing the equivalent stiffness and damping changes the natural frequency ω of the vibration absorber n , to absorb vibrations of different frequencies at the end of the robot arm.

[0087] In this embodiment, the power amplifier 3 is a PWM power amplifier, including a pulse modulator and a switching amplifier. The pulse modulator switches the amplifier on and off at a fixed frequency. Compared with a linear power amplifier, the PWM power amplifier has a smaller loss, does not cause overheating, and can output a larger power. After the power amplifier 3 enhances the small signal, it directly outputs the amplified current signal to the coil winding of the coil cavity. In some embodiments, the power amplifier 3 can also be regarded as a proportional amplification link to avoid signal distortion and delay, which is conducive to simplifying the modeling. The input voltage signal range of the power amplifier 3 is [-μV, μV], and the output current is [0A, 2I0A], so the gain of the power amplifier 3 is:

[0088] Test verification:

[0089] An eddy current displacement sensor 2 is installed at one end of the electromagnetic damping vibration absorber 1 to capture the vibration displacement signal The vibration displacement signal One section is considered as an ideal proportional link. The single-sided air gap of the electromagnetic damping vibration absorber 1 is 1 mm, but in order to protect the thrust plate and other devices, the displacement stroke of the thrust plate must be less than 1 mm. Therefore, the axial displacement stroke of the thrust plate is set to 0 mm to 21 mm. In the linear stage of the displacement sensor 2, the output displacement voltage signal range is set to 0 V to μV, and the gain of the displacement sensor 2 in the system is K. w =μ×10 4 / 2l(V / m). Figure 3 The input vibration displacement signal is shown After 1 second, a simulated disturbance signal is input, and it can be seen that the vibration displacement increases significantly.

[0090] Reference Figure 4 The simulation results are shown. After 1s, the control algorithm is added and compared with Figure 3 Compared with the change of vibration displacement when there is no control algorithm, this embodiment has a good effect on the vibration suppression when the robot is working, and has a fast response speed and a simple structure. The problem of large vibration caused by the robot during operation can be properly solved.

[0091] Example 2

[0092] The embodiment of the present application provides an adaptive vibration suppression system, wherein the adaptive vibration suppression system adopts an adaptive vibration suppression method according to any one of claims 1 to 5, such as Figure 5 The system shown includes:

[0093] The electromagnetic damping vibration absorber 1 is installed on the base of the robot arm. During the drilling process of the robot, due to the existence of the reverse force, the vibration force will be transmitted through the robot wrist such as the end effector structure to the forearm, elbow joint, upper arm of the robot arm and finally to the base, causing the vibration of the entire workbench;

[0094] The displacement sensor 2 is installed on the electromagnetic damping vibration absorber 1 and is configured to collect the vibration displacement signal on the core shaft 12 of the electromagnetic damping vibration absorber 1 in real time. And the vibration displacement signal Pretreatment;

[0095] The LabVIEW data processing system 3 is configured to acquire and process the vibration displacement signal Calculate the vibration displacement signal The amplitude A, amplitude B and frequency ω n ;

[0096] The fuzzy control module 4 is configured to obtain and process the amplitude A, the amplitude B and the frequency ω n , get the optimal PID control parameter K P , K I , K D

[0097] The PID controller 5 is configured to obtain the optimal PID control parameter K P , K I , K D , and outputs the vibration suppression parameters after processing based on the set fuzzy control strategy. The vibration suppression parameters are processed by the power amplifier 3 to output the corresponding working current, and the working current is transmitted to the electromagnetic damping vibration absorber 1 to control the current of the coil winding in the electromagnetic damping vibration absorber 1, so as to realize real-time control of the electromagnetic force of the electromagnetic damping vibration absorber 1, thereby suppressing the vibration of the robot arm during operation.

[0098] In an embodiment, Figure 6-7 As shown, the electromagnetic damping vibration absorber 1 comprises: a cylindrical shell 11, the top of the cylindrical shell 11 is the upper end cover of the shell, the bottom is the lower end cover of the shell, a core shaft 12 is arranged at the axial position of the cylindrical shell 11, the core shaft 12 passes through the upper end cover and the lower end cover of the shell, and the core shaft 12 is sequentially arranged with a first coil 121, a push disk 122 and a second coil 123. Further, the displacement sensor 2 is mounted on the core shaft 12.

[0099] During the robot drilling process, due to the existence of the reverse force, the vibration force will be transmitted through the robot wrist, such as the end effector structure, to the forearm, elbow joint, and upper arm of the robot arm, and finally to the mandrel 12 of the electromagnetic damping vibration absorber 1 connected to the base. Therefore, the mandrel 12 will also be affected by the corresponding vibration, resulting in the generation of vibration displacement. In this embodiment, in order to more accurately reflect the vibration situation, the displacement sensor 2 is an eddy current displacement sensor 2 to detect the displacement vibration signal of the mandrel 12, but it is not limited to this.

[0100] The eddy current displacement sensor 2 has high sensitivity and accurate displacement measurement capability, and is suitable for detecting tiny vibrations. By installing the sensor on the core shaft 12 of the electromagnetic damping vibration absorber 1, the vibration displacement of the core shaft 12 can be sensed in real time and accurately. This avoids installing too many sensors on the entire robot structure, simplifies the system structure, and ensures high-quality collection of vibration signals. By continuously detecting the vibration displacement signal of the core shaft 12 of the electromagnetic damping vibration absorber 1, the vibration displacement signal of the core shaft 12 of the electromagnetic damping vibration absorber 1 can be accurately sensed in real time. The system can quickly sense the vibration changes caused by the reverse force and provide accurate and real-time feedback to the vibration suppression system.

[0101] The foregoing Figure 1 The various variations and specific examples of an adaptive vibration suppression method in Embodiment 1 are also applicable to an adaptive vibration suppression device in this embodiment. Through the above detailed description of an adaptive vibration suppression method, those skilled in the art can clearly know the implementation method of an adaptive vibration suppression device in this embodiment, so for the sake of brevity of the specification, it will not be described in detail here.

[0102] Example 3

[0103] A robot, comprising the adaptive vibration suppression system as above.

[0104] In summary, the present invention combines the LabVIEW data processing system and the fuzzy control module. The LabVIEW data processing system acquires the real-time vibration amplitude and frequency information of the vibration signal online. The former has a simple structure, and the fuzzy control module has good robustness and adjustable parameters. The PID controller and the power abandonment are coordinated to realize adaptive vibration control, which has a high efficiency in suppressing vibration. The vibration suppression method is simple and easy to adjust. It can suppress the vibration of the robot arm during high-speed movement, and improve product quality and operation efficiency.

[0105] In the description of this specification, the description with reference to the terms "one embodiment", "some embodiments", "illustrative embodiments", "examples", "specific examples", or "some examples" means that the specific features, structures, materials or characteristics described in conjunction with the embodiment or example are included in at least one embodiment or example of the present invention. In this specification, the schematic representation of the above terms does not necessarily refer to the same embodiment or example. Moreover, the specific features, structures, materials or characteristics described may be combined in any one or more embodiments or examples in a suitable manner.

[0106] Based on the above ideal embodiments of the present invention, the relevant staff can make various changes and modifications without departing from the technical concept of the present invention through the above description. The technical scope of the present invention is not limited to the contents of the specification, but must be determined according to the scope of the claims.

Claims

1. An adaptive vibration suppression method, characterized in that: The method comprises the following steps: S1, collecting the vibration displacement signal on the core shaft (12) of the electromagnetic damping vibration absorber (1) in real time through the displacement sensor (2) And the vibration displacement signal Pretreatment; S2, acquiring and processing the vibration displacement signal through the LabVIEW data processing system (3) The vibration displacement signal is calculated The amplitude A, amplitude B and frequency ω n ; S3, the amplitude A, amplitude B and frequency ω n Transmitted to the fuzzy control module (4) for processing, the optimal PID control parameter K is obtained P , K I , K D ; S4, PID controller (5) obtains the optimal PID control parameter K P , K I , K D , and after processing based on a set fuzzy control strategy, a vibration suppression parameter is output; the vibration suppression parameter is processed by a power amplifier (3) and then a corresponding working current is output; and the working current is transmitted to the electromagnetic damping vibration absorber (1) to control the current of the coil winding in the electromagnetic damping vibration absorber (1), thereby achieving real-time control of the electromagnetic force of the electromagnetic damping vibration absorber (1), and thereby suppressing the vibration of the robot arm during operation.

2. The adaptive vibration suppression method according to claim 1, characterized in that: In step S1, the vibration displacement signal De-noising filtering based on infinite impulse response filter.

3. The adaptive vibration suppression method according to claim 1, characterized in that: The step S3 specifically includes the following steps: Get the amplitude A, the amplitude B and the frequency ω n ; The amplitude A, the amplitude B and the frequency ω n Compare with the preset values ​​to obtain the current displacement error e; Calculate the change rate E between the current displacement error e and the previous displacement error; Based on the current displacement error e and the change rate E, a preset fuzzy rule is queried in the fuzzy set domain to obtain a PID correction parameter in the fuzzy set domain; The PID correction parameters are defuzzified using the triangular membership function to obtain the optimal PID control parameter K P , K I , K D .

4. The adaptive vibration suppression method according to claim 1, characterized in that: In step S4, when the electromagnetic force of the electromagnetic damping vibration absorber (1) is controlled in real time, the natural frequency of the electromagnetic damping vibration absorber (1) is made equal to the external interference frequency, and the thrust plate of the electromagnetic damping vibration absorber (1) is controlled to be in the middle position to absorb the vibration caused by the end of the robot arm.

5. The adaptive vibration suppression method according to claim 4, characterized in that: In step S4, the electromagnetic force F of the electromagnetic damping vibration absorber (1) is expressed as: F=k i i+k x x Among them, k i , k x is the current stiffness and displacement stiffness coefficient, x is the displacement distance of the core shaft (12) of the electromagnetic damping vibration absorber (1), and i is the working current; According to Newton's law, the kinematic equation of the thrust plate of the electromagnetic damping vibration absorber (1) is expressed as: Wherein, m is the total mass of the thrust plate and the core shaft (12); From the Laplace transform we get: By controlling the thrust plate through the PID controller (5), the relationship between the equivalent stiffness and equivalent damping of the corresponding electromagnetic damping vibration absorber (1) and the PID control parameters is expressed as follows: Among them, k w , k g are the displacement gain coefficient and the power amplifier (3) gain coefficient, and T is the low-pass filter coefficient of the PID controller (5); When the electromagnetic damping vibration absorber (1) is working, the natural frequency ω of the vibration absorber n When the frequency ω of the external disturbance is kept consistent, the purpose of absorbing vibration is achieved, that is, it satisfies: Based on the optimal PID control parameter K P , K I , K D Changing the equivalent stiffness and damping changes the natural frequency ω of the vibration absorber n , to absorb vibrations of different frequencies at the end of the robot arm.

6. An adaptive vibration suppression system, characterized in that: The adaptive vibration suppression system adopts the adaptive vibration suppression method according to any one of claims 1 to 5, and the system comprises: An electromagnetic damping vibration absorber (1) is mounted on a base of the robot arm; A displacement sensor (2) is mounted on the electromagnetic damping vibration absorber (1) and is configured to collect a vibration displacement signal on the core shaft (12) of the electromagnetic damping vibration absorber (1) in real time. And the vibration displacement signal Pretreatment; A LabVIEW data processing system (3) configured to acquire and process the vibration displacement signal The vibration displacement signal is calculated The amplitude A, amplitude B and frequency ω n ; A fuzzy control module (4) is configured to obtain and process the amplitude A, amplitude B and frequency ω n , get the optimal PID control parameter K P , K I , K D PID controller (5), configured to obtain the optimal PID control parameter K P , K I , K D , and after processing based on a set fuzzy control strategy, a vibration suppression parameter is output; the vibration suppression parameter is processed by a power amplifier (3) and then a corresponding working current is output; and the working current is transmitted to the electromagnetic damping vibration absorber (1) to control the current of the coil winding in the electromagnetic damping vibration absorber (1), thereby achieving real-time control of the electromagnetic force of the electromagnetic damping vibration absorber (1), and thereby suppressing the vibration of the robot arm during operation.

7. The adaptive vibration suppression system according to claim 6, characterized in that: The electromagnetic damping vibration absorber (1) comprises: a cylindrical shell (11), the top of the cylindrical shell (11) being an upper end cover of the shell, and the bottom being a lower end cover of the shell, a core shaft (12) being arranged at the axial center position of the cylindrical shell (11), the core shaft (12) passing through the upper end cover of the shell and the lower end cover of the shell, and a first coil (121), a pushing disk (122) and a second coil (123) being arranged in sequence on the core shaft (12).

8. The adaptive vibration suppression system according to claim 7, characterized in that: The displacement sensor (2) is mounted on the core shaft (12).

9. A robot, characterized in that: The robot comprises an adaptive vibration suppression system as claimed in any one of claims 6 to 8.

Citation Information

Cited By

  • Intelligent vibration suppression system for telescopic arm body of overhead working truck and control method

    CN121376877A