A method and apparatus for testing servo motor frequency sweep.
By constructing a test device to apply an asymmetric linear load and motion dead zone, and using a pressure sensor to calculate the servo motor deflection angle, the problem of large measurement error in the bandwidth of servo motors in the prior art is solved, and more accurate bandwidth measurement is achieved.
Patent Information
- Application Number
- CN202611267690.6
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2026-08-20
- Publication Date
- 2026-11-17
AI Technical Summary
Existing frequency sweep testing methods cannot simulate the asymmetric linear load and motion dead zone under real flight conditions, resulting in large measurement errors in the bandwidth of servo motors.
A test setup was constructed to apply an asymmetric linear load and motion dead zone. The servo deflection angle was calculated by collecting spring force data through a pressure sensor, and the bandwidth was calculated using an open-loop Bode plot.
It accurately measures the bandwidth of servo motors under asymmetric linear loads, reduces measurement errors, and is suitable for servo motors without angle feedback, thus expanding its application range.
Smart Images

Figure CN123113805A_ABST
Abstract
Description
Technical Field
[0001] This invention belongs to the field of control technology, and specifically relates to a servo motor frequency sweep test method and test device. Background Technology
[0002] Servo motors have advantages such as high precision, high stability, high torque, and low power consumption. They are widely used in the fields of unmanned aerial vehicles (UAVs) and robotics, and are important actuators in UAV and robotic systems.
[0003] In unmanned aerial vehicle (UAV) systems, servo motors receive control commands from the onboard flight controller and drive the UAV's control surfaces to deflect, thereby altering the UAV's flight attitude and trajectory to achieve precise flight control and complete planned flight path tasks. The servo motor's ability to track input commands directly affects the UAV's flight control performance and flight quality, and even its flight safety.
[0004] In robotic systems, servo motors are typically mounted on the robot's joints. The controller precisely positions and controls the movement of various robot parts by controlling the deflection or angle of the servo motors, enabling complex actions such as robot dancing, robot soccer, and robot fighting. The performance of the servo motors directly impacts the rapid response and stability of the robot's motion control, determining whether the robot can complete tasks with high quality.
[0005] Besides response speed and damping ratio, the bandwidth of a servo motor also affects its ability to track input commands. Therefore, accurately obtaining the bandwidth of a servo motor is of great value for the development, design, and engineering applications of UAV or robotic systems. However, due to the complexity of servo motors themselves, the difficulty and inaccuracy of measuring component parameters, and the influence of factors such as load changes, environmental changes, and component aging, accurately measuring the bandwidth of a servo motor is quite challenging. Among these factors, load changes are the most significant external influencing factor. Furthermore, in the various application scenarios of servo motors, asymmetrical linear loads are a common operating condition. For example, the aerodynamic loads generated when an aircraft control surface deflects up and down are generally asymmetrical, and the hinge torque borne by the servo motor in this situation is an asymmetrical linear load. In addition, when transmitting motion and torque, servo motors typically rely on mechanisms such as linkages and hinges, which inevitably create dead zones, which also affect the bandwidth of the entire servo system.
[0006] Existing frequency sweep testing methods, such as the Chinese invention patent: A servo motor bandwidth testing method based on constant load, application publication number: CN121115711A, disclose the following steps: Step S1: Perform frequency sweep testing: Under constant load, a sine wave command signal is sent to the servo motor under test, with a sending period of T, and the signal frequency gradually changes from low frequency to high frequency over time; The servo motor under test follows the sine wave command signal to perform frequency sweep, driving the rocker arm to reciprocate up and down, and simultaneously driving the load to simulate the mass block to reciprocate up and down; At the same time, during the rotation of the servo motor output shaft, the deflection angle of the servo motor output shaft is analyzed; Step S2: Obtain the displacement of the simulated load mass; and calculate the actual deflection angle θ of the rocker arm:
[0007] Where: S is the displacement of the simulated mass block under load; L is the distance between the load adjustment fixture and the output shaft of the servo motor under test; Step S3: Obtain the open-loop Bode plot of the servo motor using the sine wave command and deflection angle, and obtain the bandwidth of the servo system based on the Bode plot.
[0008] The above document has the following problems: Existing technologies simulate constant torque by utilizing the product of gravity and lever arm. However, in actual aircraft flight, the greater the deflection angle of the control surfaces, the greater the air resistance, resulting in an asymmetrical linear load. Existing technologies cannot simulate this asymmetrical linear load and also fail to consider the impact of factors such as motion dead zones on the bandwidth of servo motors, leading to significant measurement errors between test results and actual flight conditions. Summary of the Invention
[0009] The purpose of this invention is to overcome the aforementioned problems and propose a servo sweep frequency test method and test device. This solves the problem that existing technologies cannot simulate asymmetric linear loads under real flight conditions, and also do not consider the influence of motion dead zone on the bandwidth of servo motors, resulting in large measurement errors between the test results and real flight conditions.
[0010] To achieve the above objectives, the technical solution adopted by the present invention is as follows: A servo motor frequency sweep test method, characterized by the following specific steps: A test device is constructed to apply an asymmetric linear load and motion dead zone to a servo motor to test its bandwidth. Under the asymmetric linear load condition, a specific sine wave command signal is periodically sent to the servo motor to drive the test device to reciprocate. During the operation of the servo motor, the deformation of the test device is recorded, and the deflection angle of the servo motor's output shaft is calculated from the deformation. The open-loop Bode plot of the test is obtained using the sine wave command and the deflection angle. The bandwidth of the servo system under this nonlinear load condition is calculated using the open-loop Bode plot. If the bandwidth of the servo motor under test is greater than twice the control system command frequency, it is considered a safe bandwidth.
[0011] The specific steps are as follows: Step s1: Determine the positions of the first pressure tester on the third slide rail and the second pressure tester on the fourth slide rail in the test device according to the asymmetric linear load ratio coefficient corresponding to the test setting; determine the positions of the third slide rail and the fourth slide rail in the test device between the first and second slide rails according to the motion dead zone size set in the test, and construct a test device for applying asymmetric linear load and motion dead zone test bandwidth to the servo motor; Step s2: The servo motor under test in the test device drives the rocker arm on the servo motor under test to perform reciprocating deflection motion according to the sine wave command signal sent by the test computer in a periodic manner. Step s3: The first and second pressure testers in the extrusion test device for the reciprocating deflection motion of the rocker arm on the servo motor under test are used to collect pressure data periodically. The deformation of the springs in the first and second pressure testers within the period is calculated using the pressure data. The deflection angle of the rocker arm on the servo motor under test is calculated based on the deformation of the springs in the first and second pressure testers. Step s4: Obtain the open-loop Bode plot of the test using the sine wave command and deflection angle; Step s5: Calculate the bandwidth of the servo system under the nonlinear load condition using the open-loop Bode plot; if the bandwidth of the servo motor under test is greater than twice the control system command frequency, then it is a safe bandwidth.
[0012] In step s1, the linear load set by the first pressure tester is the spring force exerted by the spring inside the first pressure tester on the rocker arm of the servo motor under test when the rocker arm contacts the first pressure tester. The distance from the geometric center of the slider of the first pressure tester to the vertical projection point of the output shaft of the servo motor under test on the third slide rail is calculated using the linear proportional coefficient corresponding to the linear load set by the first pressure tester and the spring elasticity coefficient of the first pressure tester. L 1. The calculation formula is as follows:
[0013] In the formula, G 1 represents the linear proportionality coefficient of the linear load experienced by the rocker arm of the servo motor under test when it deflects toward the first pressure tester, in units of... N · m / °; K 1 represents the spring constant of the spring inside the first pressure tester, in units of... N / m ; S A scale for converting radians to degrees.
[0014] In step s1, the position of the first pressure tester on the third slide rail is measured from the vertical projection point of the output shaft of the servo motor under test on the third slide rail towards the first slide rail. L The location at point 1.
[0015] In step s1, the linear load set by the second pressure tester is the spring force exerted by the rocker arm on the servo under test on the rocker arm when it contacts the second pressure tester. The distance from the geometric center of the slider of the second pressure tester to the vertical projection point of the output shaft of the servo under test on the fourth slide rail is calculated using the linear proportional coefficient corresponding to the linear load set by the second pressure tester and the spring elasticity coefficient of the second pressure tester. L 2. The calculation formula is as follows:
[0016] In the formula, G 2 represents the linear proportionality coefficient of the linear load experienced by the rocker arm of the servo motor under test when it deflects toward the second pressure tester, in units of... N·m / °; K 2 represents the spring constant of the spring inside the second pressure tester, in units of... N / m .
[0017] In step s1, the position of the second pressure tester on the fourth slide rail is measured from the vertical projection point of the output shaft of the servo motor under test on the fourth slide rail towards the first slide rail. L The location at point 2.
[0018] In step s2, the first pressure tester, whose position was determined in step s1, contacts the rocker arm on the servo motor under test without considering the dead zone and when the measurement signal is 0. The projected length of the line connecting the output shaft of the servo motor under test and the geometric center of the slider clamping the third slide rail on the first slide rail is measured on the second slide rail. S 10 ; Utilizing the projected length on the second slide rail S 10The position of the slider holding the third slide rail on the first slide rail is calculated based on the motion dead zone. S 1. The calculation formula is as follows:
[0019] In the formula: The unit is degrees, used to simulate the motion dead zone of a servo motor when it works in conjunction with mechanisms such as hinges and linkages.
[0020] The slider holding the third slide rail is fixed on the first slide rail at a position measured along the first slide rail and towards the third slide rail, starting from the vertical projection point of the output shaft of the servo motor under test on the first slide rail. S Location 1.
[0021] The position of the slider of the second slide rail clamping the third slide rail is the calculated position of the slider of the first slide rail clamping the third slide rail symmetrical to the position of the second slide rail.
[0022] In step s2, when the second pressure tester, whose position was determined in step s1, contacts the rocker arm on the servo motor under test without considering the dead zone and the measurement signal is 0, the projected length of the line connecting the output shaft of the servo motor under test and the geometric center of the slider holding the fourth slide rail on the first slide rail is measured on the second slide rail. S 20 ; Utilizing the projected length on the second slide rail S 20和运动 Dead zone calculation: The position of the slider holding the fourth slide rail on the first slide rail under the motion dead zone. S 2. The calculation formula is as follows:
[0023] In the formula: The unit is degrees, used to simulate the motion dead zone of a servo motor when it works in conjunction with mechanisms such as hinges and linkages.
[0024] The slider holding the fourth slide rail is fixed on the first slide rail at a position measured along the first slide rail and towards the fourth slide rail, starting from the vertical projection point of the output shaft of the servo motor under test on the first slide rail. S Two locations.
[0025] The position of the slider of the second slide rail clamping the fourth slide rail is the calculated position of the slider of the first slide rail clamping the fourth slide rail symmetrical to the position of the second slide rail.
[0026] In step s3, the test computer sends a sine wave command signal to the servo motor under test. The sending period is T, and the signal frequency gradually changes from low to high over time. The servo motor under test follows the sine wave command signal to sweep the frequency, driving the rocker arm on the servo motor under test to perform reciprocating deflection motion.
[0027] The sine wave command signal is calculated using the following formula:
[0028]
[0029] In the formula, U(t) This is the deflection angle command for the output shaft of the servo motor under test, i.e., the target deflection angle value of the rocker arm, in degrees. t Time, in seconds. w(t) The signal frequency is expressed in radians per second.
[0030] In step s4, the test computer samples the pressure signals output by the first and second pressure testers according to the period T, and calculates the deformation of the springs in the first and second pressure testers in each sampling period based on the sampled pressure magnitude and the spring elastic coefficient.
[0031] The deformation of the spring inside the first pressure tester is calculated using the following formula:
[0032] In the formula, h 1 represents the deformation of the spring inside the first pressure tester, in units of... m ; f 1 represents the pressure measured by the first pressure tester, in Newtons.
[0033] The deformation of the spring inside the second pressure tester is calculated using the following formula:
[0034] In the formula, h 2 represents the deformation of the spring inside the second pressure tester, in units of... m ; f 2 represents the pressure measured by the second pressure tester, in Newtons.
[0035] In step s5, when the rocker arm on the servo motor under test reciprocates and squeezes the first pressure tester and the second pressure tester, the rocker arm on the servo motor under test and the compression deformation trajectory of the springs in the first pressure tester and the second pressure tester form a triangle. The deflection angle of the rocker arm on the servo motor under test toward the springs in the first pressure tester and the second pressure tester is determined based on the triangle and the deformation of the springs in the first pressure tester and the second pressure tester.
[0036] The deflection angle is the angle between the rocker arm on the servo motor under test and the side of the test bench base parallel to the third slide rail.
[0037] The deflection angle of the rocker arm on the servo motor under test toward the first pressure tester is calculated using the following formula:
[0038] In the formula, θ 1 represents the angle at which the first pressure tester deflects.
[0039] The deflection angle of the rocker arm on the servo motor under test toward the second pressure tester is calculated using the following formula:
[0040] In the formula, θ 2 represents the angle at which the second pressure tester deflects.
[0041] In step s6, the bandwidth of the servo motor under test is calculated based on the sine wave command signal and the deflection angle of the rocker arm on the servo motor under test.
[0042] A servo motor sweep frequency testing device, characterized in that: it includes a test bench base, a first slide rail and a second slide rail arranged parallel to both sides of the test bench base, a third slide rail and a fourth slide rail arranged parallel to each other between the first slide rail and the second slide rail, a servo motor under test, a first pressure tester arranged on the third slide rail, and a second pressure tester arranged on the fourth slide rail; the servo motor under test is vertically fixedly connected to the front end of the second slide rail and between the third slide rail and the fourth slide rail by a servo motor mounting fixture on the test bench base, and a rocker arm is fixedly connected to the upper surface of the servo motor under test through the output shaft of the servo motor under test, and the rocker arm is located between the first pressure tester and the second pressure tester; The third and fourth slide rails and the servo motor under test are perpendicular to the first and second slide rails. Both the first and second pressure testers include a slider, a pressure sensor, and a spring. The pressure sensor is fixedly connected to the surface of the slider relative to the rocker arm, and a spring is fixedly connected to the pressure sensor. A spring sleeve is provided on the outside of the spring. The slider on the first pressure tester slides on the third slide rail. The slider on the second pressure tester slides on the fourth slide rail. The positions of the first pressure tester on the third slide rail and the second pressure tester on the fourth slide rail are determined by a set asymmetrical linear load. The positions of the third and fourth slide rails are determined according to the set motion dead zone size.
[0043] The first and second slide rails are slidably connected by sliders, which clamp the third and fourth slide rails between the first and second slide rails.
[0044] The first and second pressure testers are electrically connected to the test computer.
[0045] The advantages of using this invention are: First, existing technologies cannot simulate such asymmetric linear loads and do not consider motion dead zones. Compared with existing technologies, this invention addresses the impact of asymmetric linear loads by flexibly configuring the test device to handle different deflection conditions for the required linear load, simulating real flight conditions. This avoids measurement errors caused by the inability to simulate asymmetric linear loads in no-load testing, and the measured bandwidth data accurately reflects the performance limits of the servo motor under asymmetric forces. Regarding motion dead zones, the test device is adjusted according to the set motion dead zone size to avoid transmission deviations and response delays caused by motion dead zones. The measured bandwidth is more accurate and accurately reflects the response capability of the servo motor under test during minute attitude corrections.
[0046] Second, compared with the prior art, the present invention uses a pressure sensor to collect the spring force and calculate the deflection angle of the servo motor output shaft. Since the signal from the pressure sensor to the test computer is an analog quantity, the test computer can obtain a higher signal sampling frequency, the test system delay is small, and the test error caused by the delay of the test system is reduced.
[0047] Third, compared with the prior art, this invention utilizes a pressure sensor to measure the deformation of the spring during the rotational motion of the servo motor's output shaft. The rotation angle of the servo motor's output shaft is indirectly calculated from the deformation, making the method applicable to servo motors that lack angle feedback or are difficult to transmit angle information to testing equipment. Furthermore, this invention can test the bandwidth of servo motors under both asymmetric and symmetric linear load conditions, expanding its applicability. Attached Figure Description
[0048] Figure 1 This is an overall diagram of the servo motor bandwidth testing equipment of the present invention; Figure 2 This is an enlarged view of the servo motor under test in the servo motor bandwidth testing equipment of this invention; Figure 3 This is an enlarged view of the spring in the servo motor bandwidth testing device of the present invention; Figure 4 This is a schematic diagram illustrating the principle of applying a constant load to the servo motor of the present invention. Figure 5 This is a schematic diagram of the test signal flow of the present invention; Figure 6 The Bode plot is obtained from the test example of this invention.
[0049] Reference numerals in the attached diagram: 1. Test bench base; 2. Servo motor under test; 3. Third slide rail; 4. Fourth slide rail; 5. Second slide rail; 6. First slide rail; 7. First pressure tester; 8. Second pressure tester; 9. Slider; 10. Pressure sensor; 11. Spring; 12. Spring sleeve; 13. Servo motor mounting fixture; 14. Rocker arm; 15. Output shaft of the servo motor under test. Detailed Implementation
[0050] Example 1 A servo motor frequency sweep test method, the specific steps of which are as follows: A test device is constructed to apply an asymmetric linear load and motion dead zone to a servo motor to test its bandwidth. Under the asymmetric linear load condition, a specific sine wave command signal is periodically sent to the servo motor to drive the test device to reciprocate. During the operation of the servo motor, the deformation of the test device is recorded, and the deflection angle of the servo motor's output shaft is calculated from the deformation. The open-loop Bode plot of the test is obtained using the sine wave command and the deflection angle. The bandwidth of the servo system under this nonlinear load condition is calculated using the open-loop Bode plot. If the bandwidth of the servo motor under test is greater than twice the control system command frequency, it is considered a safe bandwidth.
[0051] The specific steps are as follows: Step s1: Determine the position of the first pressure tester 7 on the third slide rail 3 and the position of the second pressure tester 8 on the fourth slide rail 4 in the test device according to the asymmetric linear load ratio coefficient corresponding to the test setting; determine the position of the third slide rail 3 between the first slide rail 6 and the second slide rail 5 and the position of the fourth slide rail 4 between the first slide rail 6 and the second slide rail 5 in the test device according to the motion dead zone size set in the test, and construct a test device for applying asymmetric linear load and motion dead zone test bandwidth to the servo motor. Step s2: The servo motor 2 under test in the test device drives the rocker arm 14 on the servo motor 2 to perform reciprocating deflection motion according to the sine wave command signal sent by the test computer in a periodic manner. Step s3: The rocker arm 14 on the servo motor 2 under test reciprocates and deflects, compressing the first pressure tester 7 and the second pressure tester 8 in the extrusion testing device, so that the first pressure tester 7 and the second pressure tester 8 collect pressure data periodically, and use the pressure data to calculate the deformation of the springs in the first pressure tester 7 and the second pressure tester 8 within the period; calculate the deflection angle of the rocker arm 14 on the servo motor 2 under test based on the deformation of the springs in the first pressure tester 7 and the second pressure tester 8. Step s4: Obtain the open-loop Bode plot of the test using the sine wave command and deflection angle; Step s5: Calculate the bandwidth of the servo system under the nonlinear load condition using the open-loop Bode plot; if the bandwidth of the servo motor under test is greater than twice the control system command frequency, then it is a safe bandwidth.
[0052] In step s1, the linear load set by the first pressure tester 7 is the elastic force exerted by the spring 11 inside the first pressure tester 7 on the rocker arm 14 of the servo motor 2 under test when the rocker arm 14 contacts the first pressure tester 7. The position L1 of the first pressure tester 7 on the third slide rail 3 is calculated using the linear proportional coefficient corresponding to the linear load of the first pressure tester 7 and the elastic coefficient of the spring 11 of the first pressure tester 7. The calculation formula is as follows:
[0053] In the formula, G 1 represents the linear proportionality coefficient of the linear load experienced by the rocker arm of the servo motor under test when it deflects toward the first pressure tester, in units of... N · m / °; K 1 represents the spring constant of the spring inside the first pressure tester, in units of... N / m ; S A scale for converting radians to degrees.
[0054] In step s1, the position of the first pressure tester 7 on the third slide rail 3 is the position L1 measured from the vertical projection point of the output shaft of the servo motor 2 under test on the third slide rail 3 towards the first slide rail 6.
[0055] In step s1, the linear load set by the second pressure tester 8 is the elastic force exerted by the spring 11 inside the second pressure tester 8 on the rocker arm 14 of the servo motor 2 under test when the rocker arm 14 contacts the second pressure tester 8. The position L2 of the first pressure tester 7 on the third slide rail 3 is calculated using the linear proportional coefficient corresponding to the linear load of the second pressure tester 8 and the elastic coefficient of the spring 11 of the second pressure tester 8. The calculation formula is as follows:
[0056] In the formula, G2 The linear proportionality coefficient is set to the linear load experienced by the rocker arm of the servo motor under test when it deflects toward the second pressure tester, in units of... N·m / °; K 2 represents the spring constant of the spring inside the second pressure tester, in units of... N / m .
[0057] In step s1, the position of the second pressure tester 8 on the fourth slide rail 4 is the position L2 measured from the vertical projection point of the output shaft of the servo motor 2 under test on the fourth slide rail 4 towards the first slide rail 6.
[0058] In step s2, when the first pressure tester 7, whose position was determined in step s1, contacts the rocker arm 14 on the servo motor 2 under test without considering the dead zone and the measurement signal is 0, the projection length of the line connecting the geometric center of the output shaft 15 of the servo motor under test and the slider 9 on the first slide rail 6 that clamps the third slide rail 3 is measured on the second slide rail 5 is measured. S 10 ; Utilizing the projected length on the second slide rail 5 S 10 The position of the slider 9, which clamps the third slide rail 3, on the first slide rail 6 under the motion dead zone is calculated. S 1. The calculation formula is as follows:
[0059] In the formula: The unit is degrees, used to simulate the motion dead zone of a servo motor when it works in conjunction with mechanisms such as hinges and linkages.
[0060] The slider 9 that holds the third slide rail 3 is fixed on the first slide rail 6 at a position that is measured along the first slide rail 6 and towards the third slide rail 3, starting from the vertical projection point of the output shaft of the servo motor 2 under test on the first slide rail 6. S Location 1.
[0061] The position of the slider 9 of the second slide rail 5 that clamps the third slide rail 3 is the calculated position of the slider 9 of the first slide rail 6 that clamps the third slide rail 3, symmetrically located on the second slide rail 5.
[0062] In step s2, the second pressure tester 8, whose position was determined in step s1, contacts the rocker arm 14 on the servo motor 2 under test without considering the dead zone and when the measurement signal is 0. The projected length of the line connecting the geometric center of the output shaft 15 of the servo motor under test and the slider 9 clamping the fourth slide rail 4 on the first slide rail 6 is measured on the second slide rail 5. S 20 ; Utilizing the projected length on the second slide rail 5 S 20和运动 Dead zone calculation: The position of the slider 9 clamping the fourth slide rail 4 on the first slide rail 6 under the motion dead zone. S 2. The calculation formula is as follows:
[0063] In the formula: The unit is degrees, used to simulate the motion dead zone of a servo motor when it works in conjunction with mechanisms such as hinges and linkages.
[0064] The slider 9 that holds the fourth slide rail 4 is fixed on the first slide rail 6 at a position that is measured along the first slide rail 6 and towards the fourth slide rail 4, starting from the vertical projection point of the output shaft of the servo motor 2 under test on the first slide rail 6. S Two locations.
[0065] The position of the slider 9 of the second slide rail 5 that clamps the fourth slide rail 4 is the calculated position of the slider 9 of the first slide rail 6 that clamps the fourth slide rail 4, symmetrical to the position on the second slide rail 5.
[0066] In step s3, the test computer sends a sine wave command signal to the servo motor under test 2 with a sending period of T. The signal frequency gradually changes from low to high over time. The servo motor under test 2 follows the sine wave command signal to perform frequency sweep, driving the rocker arm 14 on the servo motor under test 2 to perform reciprocating deflection motion.
[0067] The sine wave command signal is calculated using the following formula:
[0068]
[0069] In the formula, U(t) This is the deflection angle command for the output shaft of the servo motor under test, i.e., the target deflection angle value of the rocker arm, in degrees. t Time, in seconds. w(t) The signal frequency is expressed in radians per second.
[0070] In step s4, the test computer samples the pressure signals output by the first pressure tester 7 and the second pressure tester 8 according to the period T, and calculates the deformation of the spring 11 in the first pressure tester 7 and the second pressure tester 8 in each sampling period based on the magnitude of the collected pressure and the elastic coefficient of the spring 11.
[0071] The deformation of the spring 11 inside the first pressure tester 7 is calculated using the following formula:
[0072] In the formula, h 1 represents the deformation of the spring inside the first pressure tester, in units of... ; f 1 represents the pressure measured by the first pressure tester, in Newtons.
[0073] The deformation of the spring 11 inside the second pressure tester 8 is calculated using the following formula:
[0074] In the formula, h 2 represents the deformation of the spring inside the second pressure tester, in units of... ; f 2 represents the pressure measured by the second pressure tester, in Newtons.
[0075] In step s5, when the rocker arm 14 on the servo motor 2 under test reciprocates and squeezes the first pressure tester 7 and the second pressure tester 8, the rocker arm 14 on the servo motor 2 under test and the compression deformation trajectory of the spring 11 in the first pressure tester 7 and the second pressure tester 8 form a triangle. The deflection angle of the rocker arm 14 on the servo motor 2 under test toward the spring 11 in the first pressure tester 7 and the second pressure tester 8 is determined according to the triangle and the deformation of the spring in the first pressure tester 7 and the second pressure tester 8.
[0076] The deflection angle is the angle between the rocker arm 14 on the servo motor 2 under test and the side of the test bench base 1 that is parallel to the third slide rail 3.
[0077] The deflection angle of the rocker arm 14 on the servo motor 2 under test toward the first pressure tester 7 is calculated using the following formula:
[0078] In the formula, θ 1 represents the angle at which the first pressure tester deflects.
[0079] The deflection angle of the rocker arm 14 on the servo motor 2 under test toward the second pressure tester 8 is calculated using the following formula:
[0080] In the formula, θ 2 represents the angle at which the second pressure tester deflects.
[0081] In step s6, the bandwidth of the servo motor under test is calculated based on the sine wave command signal and the deflection angle of the rocker arm 14 on the servo motor under test.
[0082] To enable those skilled in the art to better understand the technical solutions of this invention, several specific embodiments will be used to further illustrate the technical solutions for achieving the objectives of this invention. It should be noted that the technical solutions claimed by this invention include, but are not limited to, the following embodiments. All other embodiments obtained by those skilled in the art based on the embodiments of this invention without inventive effort should fall within the scope of protection of this invention.
[0083] To facilitate understanding of the embodiments of the present invention, the following embodiments will be explained and described in conjunction with the accompanying drawings, and the drawings do not constitute a limitation on the embodiments of the present invention.
[0084] Preferably, the servo motor frequency sweep test method under linear load conditions includes the following steps: S1: Determine the position of the slider in the first pressure tester on the third slide rail based on the linear proportional coefficient corresponding to the asymmetric linear load set in the test. The calculation method is as follows: Among them, as shown in the appendix Figure 4 As shown, L 1 represents the distance from the first pressure tester to the vertical projection point of the output shaft of the servo motor under test on the third slide rail, in units of... m , G 1 represents the linear proportionality coefficient corresponding to the linear load experienced by the rocker arm when it deflects toward the first pressure tester, in units of... N·m / °, K 1 represents the spring constant of the spring inside the first pressure tester, in units of... N / m ; S A scale for converting radians to degrees.
[0085] S2: Determine the position of the slider on the fourth slide rail within the second pressure tester based on the linear proportional coefficient corresponding to the asymmetric linear load set in the test configuration. The calculation method is as follows: Among them, as shown in the appendix Figure 4 As shown, L 2 represents the distance from the second pressure tester to the vertical projection point of the output shaft of the servo motor under test on the fourth slide rail, in units of... m , G 2 represents the linear proportionality coefficient of the linear load experienced by the rocker arm when it deflects toward the slider inside the second pressure tester, in units of... N · m / °, K 2 represents the spring constant of the spring inside the second pressure tester, in units of... N / m ; S A scale for converting radians to degrees.
[0086] Because the position of the servo motor under test is fixed, and the slider can only move with a single degree of freedom on the slide rail, the position of the servo motor under test is determined. L 1. L 2. This determines the position of the slider.
[0087] During the test preparation phase, a ruler or equidistant measuring tool can be used. Starting from the vertical projection point of the output shaft of the servo motor under test on the third slide rail, measure along the third slide rail... L The length of 1 is the position where the slider inside the first pressure tester should be fixed. Similarly, taking the vertical projection point of the output shaft of the servo motor under test on the fourth slide rail as the starting point, measure along the fourth slide rail... L The length of 2 is the position where the slider inside the second pressure tester should be fixed.
[0088] S3: Determine the position of the slider holding the third slide rail on the first slide rail and the position of the slider holding the third slide rail on the second slide rail based on the size of the motion dead zone set in the test. The calculation method is as follows: Among them, as shown in the appendix Figure 4 As shown, S 1 is the distance from the geometric center of the slider that holds the third slide rail on the first slide rail to the vertical projection point of the output shaft of the servo motor under test on the first slide rail; S 10 The distance on the second slide rail side is the projection distance of the line connecting the output shaft of the servo motor under test and the geometric center of the slider clamping the third slide rail on the first slide rail when the spring inside the first pressure tester is at rest and just in contact with the rocker arm. The unit is 1. , The dead zone size is used to simulate the motion dead zone of a servo motor when it works in conjunction with mechanisms such as hinges and linkages; the unit is °. The position of the slider holding the third slide rail fixed on the first slide rail is measured from the vertical projection point of the output shaft of the servo motor under test on the first slide rail, along the first slide rail and towards the third slide rail. S Position 1; Since the slider holding the third slide rail on the first slide rail and the slider holding the third slide rail on the second slide rail need to move synchronously to ensure that the third slide rail translates along the first and second slide rails, the position of the slider holding the third slide rail on the second slide rail is also determined after the position of the slider holding the third slide rail on the first slide rail is determined.
[0089] S4: Determine the position of the slider holding the fourth slide rail on the first slide rail and the position of the slider holding the fourth slide rail on the second slide rail based on the size of the motion dead zone set in the test. The calculation method is as follows: Among them, as shown in the appendix Figure 4 As shown, S 2为第一 The distance from the geometric center of the slider holding the fourth slide rail on the slide rail to the vertical projection point of the output shaft of the servo motor under test on the first slide rail; S 20 The distance on the second slide rail is the projected distance of the line connecting the output shaft of the servo motor under test and the geometric center of the slider holding the fourth slide rail on the first slide rail when the spring inside the second pressure tester is at rest and just in contact with the rocker arm. The unit is 1. m The slider holding the fourth slide rail is fixed on the first slide rail at a position measured along the first slide rail towards the fourth slide rail, starting from the vertical projection point of the output shaft of the servo motor under test on the first slide rail. STwo positions; since the sliders on the first and second slide rails that hold the fourth slide rail need to move synchronously to ensure that the fourth slide rail translates along the first and second slide rails, once the position of the slider holding the fourth slide rail on the first slide rail is determined, the position of the slider holding the fourth slide rail on the second slide rail is also determined accordingly.
[0090] Keeping the rocker arm parallel to the third slide rail, move the slider holding the third slide rail so that the spring on the third slide rail just contacts the rocker arm without deforming. At this point, the vertical projection distance from the output shaft of the servo motor under test to the center line of the third slide rail is... S 10 Similarly, by moving the slider holding the fourth slide rail until the spring on the fourth slide rail is just in contact with the rocker arm without deformation, the vertical projection distance from the output shaft of the servo motor under test to the center line of the fourth slide rail is... S 20 .
[0091] During the test preparation phase, a ruler or other equidistant measuring tool can be used to measure the vertical distance from the output shaft of the servo motor to the center line of the third slide rail, which is... S 10 Similarly, the vertical distance from the output shaft of the servo motor to the center line of the fourth guide rail is measured. S 20 .
[0092] S 10 and S 20 Without considering the motion dead zone, it is the projected length of the line connecting the output shaft of the servo motor under test and the geometric center of the slider that holds the third slide rail on the first slide rail on the side parallel to the test platform base and the second slide rail side. S 1 and S 2 is the projection length of the line connecting the output shaft of the servo motor under test and the geometric center of the slider clamping the third slide rail on the first slide rail, on the side of the test bench base parallel to the second slide rail, when considering the motion dead zone.
[0093] If we don't consider the dead zone, then if we put spring A close to the rocker arm, the rocker arm will be subjected to the force of the spring at any position. However, if we consider the dead zone, then if we keep a certain distance between spring A and the rocker arm, the rocker arm will not be subjected to the force of the spring when its range of motion is less than this "distance". It will only be subjected to the spring force when its range of motion is greater than this "distance".
[0094] During the test preparation phase, a ruler or equidistant measuring tool can be used. Starting from the vertical projection point of the output shaft of the servo motor under test on the first slide rail, measure along the first slide rail and towards the third slide rail. SThe length 1 represents the position where the slider holding the third slide rail should be fixed. Similarly, starting from the vertical projection point of the output shaft of the servo motor under test on the first slide rail, measure along the first slide rail and towards the fourth slide rail. S The length of 2 is the position where the slider holding the fourth slide rail should be fixed.
[0095] S5: Perform a frequency sweep test. (See attached image) Figure 5 As shown, the test computer sends a sine wave command signal to the servo motor under test with a sending period of T. The signal frequency gradually changes from low to high over time. The servo motor under test follows the sine wave command signal to sweep the frequency and drives the rocker arm to reciprocate.
[0096] During testing, the sine wave command signal will gradually change from the lowest frequency to the highest frequency, for example, from 0.1 Hz to 10 Hz.
[0097] In the simulation, the communication between the test computer and the servo motor under test is digital, with a communication period of T. The signal frequency does indeed vary according to the transmission period T, and the frequency calculation formula is: w ( t ) = 2π × 0.1 × t For example, time t When =T, frequency w (T) = 2π × 0.1 × T, time t When =2T, frequency w (2T) = 2π × 0.1 × 2T, and so on.
[0098] S6: Calculate the deformation of the spring inside the first pressure tester. (See attached diagram) Figure 5 As shown, the test computer receives the pressure signal from the first pressure tester via an analog interface and samples the pressure signal. The sampling period is consistent with the transmission period in S5. Then, based on the linear relationship between the pressure magnitude and the spring deformation (i.e., Hooke's Law), the deformation of the spring in the first pressure tester within each sampling period is calculated. The calculation method is as follows: ,in, h 1 represents the deformation of the spring inside the first pressure tester, in units of... m ; f 1 represents the pressure measured by the first pressure tester, in Newtons.
[0099] S7: Calculate the deformation of the spring inside the second pressure tester. (See attached diagram) Figure 5As shown, the test computer receives the pressure signal from the second pressure tester via an analog interface and samples the pressure signal. The sampling period is consistent with the transmission period in S5. Then, based on the linear relationship between the pressure magnitude and the spring deformation (i.e., Hooke's Law), the deformation of the spring in the second pressure tester within each sampling period is calculated. The calculation method is as follows: ,in, h 2 represents the deformation of the spring inside the second pressure tester, in units of... m , f 2 represents the pressure measured by the second pressure tester, in Newtons.
[0100] S8: Calculate the deflection angle of the rocker arm. The calculation method is as follows: and ,in, θ 1 represents the angle at which the rocker arm deflects toward the spring inside the first pressure tester. θ 2 represents the angle at which the rocker arm deflects towards the spring inside the second pressure tester; both units are degrees. Pi is the mathematical constant of a circle.
[0101] Furthermore, the deflection angle of the rocker arm is defined as: the angle between the rocker arm on the servo motor under test and the side of the test bench base parallel to the third slide rail.
[0102] S9: Calculate the bandwidth of the servo motor under test. The bandwidth of the servo motor under test can be calculated based on the two sets of data: the sine wave command signal and the deflection angle of the rocker arm. The calculation method is existing technology, such as the calculation method in application number 201811607368.9.
[0103] The testing method of this invention is used to test the bandwidth of a servo motor. The test result is the bandwidth, which is sometimes simply referred to as "bandwidth." It generally refers to the frequency value corresponding to the decrease in the amplitude-frequency characteristic curve of the servo motor's closed-loop control system to -3 dB. The significance of obtaining the servo motor's bandwidth is that, in practical applications, control systems (such as robot joint control, gimbal control, and aircraft control surfaces) must select servos based on their speed and stability requirements. Typically, the servo motor's bandwidth should be 2 to 3 times greater than the control system's command frequency to ensure a safety margin. Otherwise, if the servo motor's bandwidth is too low, it will cause delays or even oscillations in the control system.
[0104] In each transmission cycle or sampling cycle, steps S5 to S8 of Example 1 are repeated to ensure that the test computer can obtain an instruction signal value and a deflection angle value in each cycle T.
[0105] The linear proportional coefficient is determined based on the actual application requirements of the servo motor. For example, for a servo motor on an aircraft control surface, if the control surface deflection angle increases by 1°, the linear load on the servo motor increases by 1. N · m / °, then the linear proportionality coefficient is determined to be 1. N · m / °.
[0106] Specifically, when the linear scaling factors of the two linear loads mentioned above are equal, i.e. G 1= G At time 2, the load on the servo motor is a symmetrical linear load. In other words, this method can test the servo motor bandwidth under both asymmetrical linear load conditions and symmetrical linear load conditions.
[0107] Example 2 Example 2 provides a specific test case, the details of which are as follows: Preferably, the servo motor frequency sweep test method under linear load conditions includes the following steps: S1: Determine the position of the slider in the first pressure tester on the third slide rail based on the linear load set in the test. Specifically, in this test example, the spring constant in the first pressure tester is... K 1 = 150 N / m, the linear proportional coefficient corresponding to the linear load when the desired rocker arm deflects towards the slider inside the first pressure tester is set to 150 N / m. G 1 = 0.1 N·m / °; scale converted to angles S =57.3, through the formula Determine the distance from the geometric center of the slider of the first pressure tester to the vertical projection point of the output shaft of the servo motor under test on the third slide rail. L 1, that is L 1 = 0.195m.
[0108] S2: Determine the position of the slider within the second pressure tester on the fourth slide rail based on the linear load set in the test. Specifically, in this test example, the spring constant within the second pressure tester is... K 2 = 150 N / m, the linear proportionality coefficient corresponding to the linear load on the desired rocker arm when it deflects toward the slider inside the second pressure tester is set to . G 2 = 0.15 N·m / °; scale converted to angles S =57.3 radian scale converted to degrees S =57.3, through the formula Determine the distance from the geometric center of the slider of the second pressure tester to the vertical projection point of the output shaft of the servo motor under test on the fourth slide rail. L 2, that is L 2 = 0.239m.
[0109] S3: Determine the position of the slider holding the third slide rail on the first slide rail and the position of the slider holding the third slide rail on the second slide rail, based on the motion dead zone size set for the test. Specifically, in this test example, the desired simulated dead zone size is... Through formula Calculate the distance on the second slide rail side of the line connecting the output shaft of the servo motor under test and the geometric center of the slider holding the third slide rail on the first slide rail when the spring inside the first pressure tester is stationary and just in contact with the rocker arm. S 10 =0.09m; The distance from the geometric center of the slider holding the third slide rail on the first slide rail under the motion dead zone to the vertical projection point of the output shaft of the servo motor under test on the first slide rail was determined by calculation. S 1, that is S 1 = 0.093 m .
[0110] Furthermore, since the slider holding the third slide rail on the first slide rail and the slider holding the third slide rail on the second slide rail need to move synchronously to ensure that the third slide rail translates in the direction of the rocker arm, the position of the slider holding the third slide rail on the first slide rail is also determined after the position of the slider holding the third slide rail on the second slide rail is determined.
[0111] S4: Determine the position of the slider holding the fourth slide rail on the first slide rail and the position of the slider holding the fourth slide rail on the second slide rail based on the size of the motion dead zone set in the test. Specifically, in this test example, the position is determined using the formula... When the spring inside the second pressure tester is stationary and just in contact with the rocker arm, the projection distance of the line connecting the output shaft of the servo motor under test and the geometric center of the slider clamping the fourth slide rail on the first slide rail onto the second slide rail is: S 20 =0.09m; The distance from the geometric center of the slider holding the fourth slide rail on the first slide rail under the motion dead zone to the vertical projection point of the output shaft of the servo motor under test on the first slide rail was determined by calculation. S 2, that is S 2 = 0.094m.
[0112] Furthermore, since the slider holding the fourth slide rail on the first slide rail and the slider holding the fourth slide rail on the second slide rail need to move synchronously to ensure that the fourth slide rail translates in the direction of the rocker arm, the position of the slider holding the fourth slide rail on the first slide rail is also determined after the position of the slider holding the fourth slide rail on the first slide rail is determined.
[0113] S5: Perform a frequency sweep test. (See attached image) Figure 5 As shown, the test computer sends a sine wave command signal to the servo motor under test with a sending period of T. The signal frequency gradually changes from low frequency to high frequency over time. The servo motor under test follows the sine wave command signal to sweep the frequency and drive the rocker arm to reciprocate.
[0114] Specifically, in this test case, the transmission period of the sine wave command signal is T = 5 milliseconds.
[0115] Specifically, in this test case, the sinusoidal command signal can be described mathematically as follows:
[0116]
[0117] in, U(t) This is the deflection angle command for the output shaft of the servo motor under test, i.e., the target deflection angle value of the rocker arm, in degrees. Time, in seconds. w(t) The signal frequency is expressed in radians per second. The signal frequency gradually changes from low to high over time. For example, when time... t= At 1 second, the signal frequency is w(t)= 0.2π radians per second (or 0.1 Hz), when time t= At 100 seconds, the signal frequency is w(t)= 20π radians per second (i.e., 10 Hz). The amplitude of the sine wave command signal is ±2 degrees.
[0118] S6: Calculate the deformation of the spring inside the first pressure tester. (See attached diagram) Figure 5 As shown, the test computer receives the pressure signal from the first pressure tester via an analog interface and samples the pressure signal. The sampling period is consistent with the transmission period in S5. Then, based on the linear relationship between the pressure magnitude and the spring deformation (i.e., Hooke's Law), the deformation of the spring in the first pressure tester within each sampling period is calculated. The calculation method is as follows: ,in, h 1 represents the deformation of the spring inside the first pressure tester, in units of... m; f 1 represents the pressure measured by the first pressure tester, in Newtons.
[0119] S7: Calculate the deformation of the spring inside the second pressure tester. (See attached diagram) Figure 5 As shown, the test computer receives the pressure signal from the second pressure tester via an analog interface and samples the pressure signal. The sampling period is consistent with the transmission period in S5. Then, based on the linear relationship between the pressure magnitude and the spring deformation (i.e., Hooke's Law), the deformation of the spring in the second pressure tester within each sampling period is calculated. The calculation method is as follows: ,in, h 2 represents the deformation of the spring inside the second pressure tester, in units of... m , f 2 represents the pressure measured by the second pressure tester, in Newtons.
[0120] S8: Calculate the deflection angle of the rocker arm. The calculation method is as follows: and ,in, θ 1 represents the angle at which the rocker arm deflects toward the spring inside the first pressure tester. θ 2 represents the angle at which the rocker arm deflects towards the spring inside the second pressure tester; both units are degrees. π Pi is the mathematical constant of a circle.
[0121] The deflection angle is the angle between the rocker arm on the servo motor under test and the side of the test bench base that is parallel to the third slide rail.
[0122] S9: Calculate the bandwidth of the servo motor under test. The bandwidth of the servo motor under test can be calculated based on the two sets of data: the sine wave command signal and the deflection angle of the rocker arm. The calculation method is existing technology and will not be elaborated upon in this invention.
[0123] Furthermore, in each transmission cycle or sampling cycle, steps S5 to S8 in Example 3 are repeated to ensure that the test computer can obtain an instruction signal value and a deflection angle value in each cycle T.
[0124] Specifically, in this test example, the basic parameters of the servo motor under test are: rated voltage of 6V, rated torque of 35kgf·cm (3.5 N·m), and rated speed of 0.18s / 60°.
[0125] The Bode plot of the servo motor under test is attached. Figure 6 As shown, the bandwidth is 59.44 radians / second (or 9.46 Hz).
[0126] In the description of this application, it should be understood that the terms "forward" and "reverse" and other terms indicating orientation or positional relationship are only for the convenience of describing this application and simplifying the description, and do not indicate or imply that the device or element referred to must have a specific orientation, or be constructed and operated in a specific orientation, and therefore should not be construed as a limitation on the scope of protection of this application.
[0127] The above description is merely a preferred embodiment of the present invention and is not intended to limit the present invention in any way. Any simple modifications or equivalent changes made to the above embodiments based on the technical essence of the present invention shall fall within the protection scope of the present invention.
[0128] Example 3 A servo motor sweep frequency testing device includes a test bench base 1, a first slide rail 6 and a second slide rail 5 arranged parallel to each other on both sides of the test bench base 1, a third slide rail 3 and a fourth slide rail 4 arranged parallel to each other between the first slide rail 6 and the second slide rail 5, a servo motor under test 2, a first pressure tester 7 arranged on the third slide rail 3, and a second pressure tester 8 arranged on the fourth slide rail 4; the servo motor under test 2 is vertically fixedly connected to the front end of the second slide rail 5 and between the third slide rail 3 and the fourth slide rail 4 via a servo motor mounting fixture 13 on the test bench base 1, and a rocker arm 14 is fixedly connected to the upper surface of the servo motor under test 2 via the output shaft 15 of the servo motor under test, and the rocker arm 14 is located between the first pressure tester 7 and the second pressure tester 8; the third slide rail 3, the second slide rail 5, the third slide rail 6, the third slide rail 7, the fourth slide rail 4 are arranged parallel to each other between the first slide rail 6 and the second slide rail 5, and a servo motor under test 2. A first pressure tester 7 arranged on the third slide rail 3 and the second slide rail 4 are arranged parallel to each other between the first slide rail 6 and the second slide rail 5, and a second pressure tester 8 arranged on the fourth slide rail 4; the third slide rail 6, the second slide rail 5, the third slide rail 6, the third slide rail 7, the fourth slide rail 4 are arranged parallel to each other between the first slide rail 6 and the second slide rail 5, and a third slide rail 6 and a fourth slide rail 4 are arranged parallel to each other between the first slide rail 6 and the second slide rail 5, and a fourth slide rail 4 are arranged parallel to each other between the first slide rail 6 and the second slide rail 5, and a fourth slide rail 4 are arranged parallel to each other between the first The four slide rails 4 and the servo motor under test 2 are perpendicular to the first slide rail 6 and the second slide rail 5; the first pressure tester 7 and the second pressure tester 8 each include a slider 9, a pressure sensor 10 and a spring 11. The pressure sensor 10 is fixedly connected to the surface of the slider 9 relative to the rocker arm 14. The spring 11 is fixedly connected to the pressure sensor 10, and a spring sleeve 12 is provided on the outside of the spring 11; the slider 9 on the first pressure tester 7 slides on the third slide rail 3; the slider 9 on the second pressure tester 8 slides on the fourth slide rail 4. The positions of the first pressure tester 7 on the third slide rail 3 and the second pressure tester 8 on the fourth slide rail 4 are determined by the set asymmetrical linear load. The positions of the third slide rail 3 and the fourth slide rail 4 are determined according to the set motion dead zone size.
[0129] A slider 9 is slidably connected to the first slide rail 6 and the second slide rail 5. The third slide rail 3 and the fourth slide rail 4 are clamped between the first slide rail 6 and the second slide rail 5 by the slider 9 on the first slide rail 6 and the second slide rail 5.
[0130] The first pressure tester 7 and the second pressure tester 8 are electrically connected to the test computer.
[0131] like Figure 1 , Figure 2 and Figure 3As shown, the servo frequency sweep test device under asymmetric linear load conditions includes: a test bench base, a servo mounting fixture, the servo under test, a rocker arm, two sets of test devices, four slide rails, and six sliders. For ease of description, the four slide rails are designated as the first slide rail, the second slide rail, the third slide rail, and the fourth slide rail; the six sliders are designated as the slider inside the first pressure tester, the slider inside the second pressure tester, the slider clamping the third slide rail on the first slide rail, the slider clamping the fourth slide rail on the first slide rail, the slider clamping the third slide rail on the second slide rail, and the slider clamping the fourth slide rail on the second slide rail. The two sets of test devices have the same structure, including sliders, pressure sensors mounted on the sides of the sliders, springs mounted on the force-sensitive surfaces of the pressure sensors, and spring sleeves fitted around the outer periphery of the springs.
[0132] The test bench base 1 is used to fix the servo motor mounting fixture 13 and the two slide rails.
[0133] Servo motor mounting fixture 13 is used to clamp and fix the servo motor 2 under test.
[0134] The output shaft of the servo motor under test 2 is perpendicular to the plane of the test bench base 1, that is, the plane formed by the side of the test bench base 1 parallel to the third slide rail 3 and the side of the test bench base 1 parallel to the second slide rail 5. A rocker arm 14 is mounted on the output shaft. When the servo motor under test 2 is working, the output shaft drives the rocker arm 14 to rotate.
[0135] The first slide rail 6 and the second slide rail 5 are both parallel to the sides of the test platform base 1 and the second slide rail 5, and are fixed to the test platform base 1 at a certain distance apart.
[0136] The slider 9 holding the third slide rail 3 and the slider 9 holding the fourth slide rail 4 on the first slide rail 6 are mounted on the first slide rail 6 and can slide linearly on the first slide rail 6.
[0137] The slider 9 that holds the third slide rail 3 on the second slide rail 5 and the slider 9 that holds the fourth slide rail 4 on the second slide rail 5 are installed on the second slide rail 5 and can slide linearly on the second slide rail 5.
[0138] One end of the third slide rail 3 is fixed to the slider 9 that holds the third slide rail 3 on the first slide rail 6, and the other end is fixed to the slider 9 that holds the third slide rail 3 on the second slide rail 5. When the slider 9 that holds the third slide rail 3 on the first slide rail 6 and the slider 9 that holds the third slide rail 3 on the second slide rail 5 move synchronously, the third slide rail 3 can move linearly on the first slide rail 6 and the second slide rail 5.
[0139] One end of the fourth slide rail 4 is fixed to the slider 9 that holds the fourth slide rail 4 on the first slide rail 6, and the other end is fixed to the slider 9 that holds the fourth slide rail 4 on the second slide rail 5. When the slider 9 that holds the fourth slide rail 4 on the first slide rail 6 and the slider 9 that holds the fourth slide rail 4 on the second slide rail 5 move synchronously, the fourth slide rail 4 can move linearly on the first slide rail 6 and the second slide rail 5.
[0140] The third slide rail 3 and the fourth slide rail 4 are parallel.
[0141] The slider 9 inside the first pressure tester 7 is mounted on the third slide rail 3 and can slide linearly on the third slide rail 3.
[0142] The slider 9 inside the second pressure tester 8 is mounted on the fourth slide rail 4 and can slide linearly on the fourth slide rail 4.
[0143] The pressure sensor 10 inside the first pressure tester 7 is fixed to the side of the slider 9 inside the first pressure tester 7, and the force-sensitive surface of the pressure sensor 10 faces the rocker arm 14.
[0144] The pressure sensor 10 inside the second pressure tester 8 is fixed to the side of the slider 9 inside the second pressure tester 8, and the force-sensitive surface of the pressure sensor 10 faces the rocker arm 14.
[0145] One end of the spring sleeve 12 inside the first pressure tester 7 is fixed to the force-sensitive surface of the first pressure tester 7, and the other end faces the rocker arm 14.
[0146] One end of the spring sleeve 12 inside the second pressure tester 8 is fixed to the force-sensitive surface of the second pressure tester 8, and the other end faces the rocker arm 14.
[0147] The spring 11 inside the first pressure tester 7 is placed inside the spring sleeve 12, and the two are coaxial. One end of the spring 11 inside the first pressure tester 7 is fixed to the force-sensitive surface of the pressure sensor 10, and the other end faces the rocker arm 14. When the servo motor under test 2 drives the rocker arm 14 to rotate, the rocker arm 14 contacts the spring 11 inside the first pressure tester 7, and the spring 11 inside the first pressure tester 7 is compressed. The pressure sensor 10 collects the elastic force generated by the spring 11 inside the first pressure tester 7.
[0148] The spring 11 inside the second pressure tester 8 is placed inside the spring sleeve 12, and the two are coaxial. One end of the spring 11 inside the second pressure tester 8 is fixed to the force-sensitive surface of the pressure sensor 10, and the other end faces the rocker arm 14. When the servo motor 2 under test drives the rocker arm 14 to rotate, the rocker arm 14 contacts the spring 11 inside the second pressure tester 8, and the spring 11 inside the second pressure tester 8 is compressed. The pressure sensor 10 will collect the elastic force generated by the spring 11 inside the second pressure tester 8.
[0149] First, to ensure effective measurement, the pressure sensor's range should be greater than 1.5 times the maximum measuring load. For example, if the linear proportionality coefficient of a linear load is 1... N·m / °, the maximum deflection angle range of the rocker arm during measurement is -5° to +5°, distance L 1. L If the value of 2 is 0.2m, then the range of the pressure sensor should be greater than [missing value]. .
[0150] Secondly, since the measurement accuracy of the pressure sensor will affect the measurement results of the bandwidth of the servo motor under test, the measurement accuracy of the pressure sensor should be better than 1% of the maximum measurement load. For example, if the maximum measurement load is 20N, the measurement accuracy of the pressure sensor should be ≤0.2N.
[0151] It should be noted that the "range" and "measurement accuracy" mentioned here are suggested values given by this invention to better achieve the purpose of the invention, and therefore should not be construed as limiting the scope of protection of this application.
Claims
1. A method for testing servo motor frequency sweep, characterized in that: The specific steps are as follows: A test device is constructed to apply an asymmetric linear load and motion dead zone to a servo motor to test its bandwidth. Under the asymmetric linear load condition, a specific sine wave command signal is periodically sent to the servo motor to drive the test device to reciprocate. During the operation of the servo motor, the deformation of the test device is recorded, and the deflection angle of the servo motor's output shaft is calculated from the deformation. The open-loop Bode plot of the test is obtained using the sine wave command and the deflection angle. The bandwidth of the servo system under this nonlinear load condition is calculated using the open-loop Bode plot. If the bandwidth of the servo motor under test is greater than twice the control system command frequency, it is considered a safe bandwidth.
2. The servo motor frequency sweep test method according to claim 1, characterized in that: The specific steps are as follows: Step s1: Determine the position of the first pressure tester (7) on the third slide rail (3) and the position of the second pressure tester (8) on the fourth slide rail (4) in the test device according to the asymmetric linear load ratio coefficient set for the test; determine the position of the third slide rail (3) between the first slide rail (6) and the second slide rail (5) and the position of the fourth slide rail (4) between the first slide rail (6) and the second slide rail (5) in the test device according to the motion dead zone size set for the test, and construct a test device for applying asymmetric linear load and motion dead zone test bandwidth to the servo motor; Step s2: The servo motor under test (2) in the test device drives the rocker arm (14) on the servo motor under test (2) to perform reciprocating deflection motion according to the sine wave command signal sent by the test computer in a periodic manner; Step s3: The rocker arm (14) on the servo motor (2) under test reciprocates and deflects, compressing the first pressure tester (7) and the second pressure tester (8) in the testing device, so that the first pressure tester (7) and the second pressure tester (8) collect pressure data periodically, and use the pressure data to calculate the deformation of the spring in the first pressure tester (7) and the second pressure tester (8) within the period; calculate the deflection angle of the rocker arm (14) on the servo motor (2) under test based on the deformation of the spring in the first pressure tester (7) and the second pressure tester (8). Step s4: Obtain the open-loop Bode plot of the test using the sine wave command and deflection angle; Step s5: Calculate the bandwidth of the servo system under the nonlinear load condition using the open-loop Bode plot; if the bandwidth of the servo motor under test is greater than twice the control system command frequency, then it is a safe bandwidth.
3. The servo motor frequency sweep test method according to claim 2, characterized in that: In step s1, the linear load set by the first pressure tester (7) is the elastic force of the spring (11) inside the first pressure tester (7) on the rocker arm (14) on the servo motor (2) under test when the rocker arm (14) on the servo motor (2) under test contacts the first pressure tester (7); the distance from the geometric center of the slider of the first pressure tester (7) to the vertical projection point of the output shaft (15) of the servo motor under test on the third slide rail (3) is calculated using the linear proportional coefficient corresponding to the linear load set by the first pressure tester (7) and the elastic coefficient of the spring (11) of the first pressure tester (7). L 1. The calculation formula is as follows: In the formula, G 1 represents the linear proportionality coefficient of the linear load experienced by the rocker arm of the servo motor under test when it deflects toward the first pressure tester, in units of... N · m / °; K 1 represents the spring constant of the spring inside the first pressure tester, in units of... N / m ; S A scale for converting radians to degrees.
4. The servo motor frequency sweep test method according to claim 3, characterized in that: In step s1, the position of the first pressure tester (7) on the third slide rail (3) is measured from the vertical projection point of the output shaft of the servo motor (2) under test on the third slide rail (3) towards the first slide rail (6). L The location at point 1.
5. The servo motor frequency sweep test method according to claim 4, characterized in that: In step s1, the linear load set by the second pressure tester (8) is the elastic force of the spring (11) inside the second pressure tester (8) on the rocker arm (14) of the servo motor (2) under test when the rocker arm (14) on the servo motor (2) under test contacts the second pressure tester (8); the distance from the geometric center of the slider of the second pressure tester (8) to the vertical projection point of the output shaft (15) of the servo motor under test on the fourth slide rail (4) is calculated using the linear proportional coefficient corresponding to the linear load set by the second pressure tester (8) and the elastic coefficient of the spring (11) of the second pressure tester (8). L 2. The calculation formula is as follows: In the formula, G 2 represents the linear proportionality coefficient of the linear load experienced by the rocker arm of the servo motor under test when it deflects toward the second pressure tester, in units of... N·m / °; K 2 represents the spring constant of the spring inside the second pressure tester, in units of... N / m .
6. The servo motor frequency sweep test method according to claim 5, characterized in that: In step s1, the position of the second pressure tester (8) on the fourth slide rail (4) is measured from the vertical projection point of the output shaft of the servo motor (2) under test on the fourth slide rail (4) towards the first slide rail (6). L The location at point 2.
7. The servo motor frequency sweep test method according to claim 6, characterized in that: In step s2, the first pressure tester (7), whose position was determined in step s1, contacts the rocker arm (14) on the servo motor (2) under test without considering the dead zone and when the measurement signal is 0, measures the projection length of the line connecting the output shaft (15) of the servo motor under test and the geometric center of the slider (9) clamping the third slide rail (3) on the first slide rail (6) on the second slide rail (5). S 10 ;Utilizing the projected length on the second slide rail (5) S 10 The position of the slider (9) clamping the third slide rail (3) on the first slide rail (6) under the motion dead zone is calculated. S 1. The calculation formula is as follows: In the formula: The unit is degrees, used to simulate the motion dead zone of a servo motor when it works in conjunction with mechanisms such as hinges and linkages.
8. The servo motor frequency sweep test method according to claim 7, characterized in that: The slider (9) that holds the third slide rail (3) is fixed on the first slide rail (6) at a position that is measured along the first slide rail (6) and towards the third slide rail (3), starting from the vertical projection point of the output shaft of the servo motor (2) under test on the first slide rail (6). S Location 1.
9. The servo motor frequency sweep test method according to claim 8, characterized in that: The position of the slider (9) of the second slide rail (5) clamping the third slide rail (3) is the calculated position of the slider (9) of the first slide rail (6) clamping the third slide rail (3) symmetrical to the position of the second slide rail (5).
10. A servo motor frequency sweep test method according to claim 9, characterized in that: In step s2, the second pressure tester (8), whose position was determined in step s1, contacts the rocker arm (14) on the servo motor (2) under test without considering the dead zone and when the measurement signal is 0, measures the projection length of the line connecting the output shaft (15) of the servo motor under test and the geometric center of the slider (9) clamping the fourth slide rail (4) on the first slide rail (6) on the second slide rail (5). S 20 ;Utilizing the projected length on the second slide rail (5) S 20和运动 Dead zone calculation: The position of the slider (9) clamping the fourth slide rail (4) on the first slide rail (6) under the motion dead zone. S 2. The calculation formula is as follows: In the formula: The unit is degrees, used to simulate the motion dead zone of a servo motor when it works in conjunction with mechanisms such as hinges and linkages.
11. The servo motor frequency sweep test method according to claim 10, characterized in that: The slider (9) that holds the fourth slide rail (4) is fixed on the first slide rail (6) at a position that is measured along the first slide rail (6) and towards the fourth slide rail (4), starting from the vertical projection point of the output shaft of the servo motor (2) under test on the first slide rail (6). S Two locations.
12. The servo motor frequency sweep test method according to claim 11, characterized in that: The position of the slider (9) of the second slide rail (5) clamping the fourth slide rail (4) is the calculated position of the slider (9) of the first slide rail (6) clamping the fourth slide rail (4) symmetrical to the position of the second slide rail (5).
13. The servo motor frequency sweep test method according to claim 12, characterized in that: In step s3, the test computer sends a sine wave command signal to the servo motor under test (2) with a sending period of T. The signal frequency gradually changes from low to high over time. The servo motor under test (2) follows the sine wave command signal to perform frequency sweep and drives the rocker arm (14) on the servo motor under test (2) to perform reciprocating deflection motion.
14. The servo motor frequency sweep test method according to claim 13, characterized in that: The sine wave command signal is calculated using the following formula: In the formula, U(t) This is the deflection angle command for the output shaft of the servo motor under test, i.e., the target deflection angle value of the rocker arm, in degrees. t Time, in seconds. w(t) The signal frequency is expressed in radians per second.
15. The servo motor frequency sweep test method according to claim 14, characterized in that: In step s4, the test computer samples the pressure signals output by the first pressure tester (7) and the second pressure tester (8) according to the period T, and calculates the deformation of the spring in the first pressure tester (7) and the second pressure tester (8) in each sampling period based on the magnitude of the collected pressure and the elastic coefficient of the spring (11).
16. The servo motor frequency sweep test method according to claim 15, characterized in that: The deformation of the spring (11) inside the first pressure tester (7) is calculated using the following formula: In the formula, h 1 represents the deformation of the spring inside the first pressure tester, in units of... m ; f 1 represents the pressure measured by the first pressure tester, in Newtons.
17. The servo motor frequency sweep test method according to claim 16, characterized in that: The deformation of the spring (11) inside the second pressure tester (8) is calculated using the following formula: In the formula, h 2 represents the deformation of the spring inside the second pressure tester, in units of... m ; f 2 represents the pressure measured by the second pressure tester, in Newtons.
18. A servo motor frequency sweep test method according to claim 17, characterized in that: In step s5, when the rocker arm (14) on the servo motor under test (2) reciprocates and squeezes the first pressure tester (7) and the second pressure tester (8), the rocker arm (14) on the servo motor under test (2) and the compression deformation trajectory of the spring (11) in the first pressure tester (7) and the second pressure tester (8) form a triangle. The deflection angle of the rocker arm (14) on the servo motor under test (2) toward the spring (11) in the first pressure tester (7) and the second pressure tester (8) is determined according to the triangle and the deformation of the spring in the first pressure tester (7) and the second pressure tester (8).
19. A servo motor frequency sweep test method according to claim 18, characterized in that: The deflection angle is the angle between the rocker arm (14) on the servo motor (2) under test and the side parallel to the test bench base (1) and the third slide rail (3).
20. A servo motor frequency sweep test method according to claim 19, characterized in that: The deflection angle of the rocker arm (14) on the servo motor (2) under test toward the first pressure tester (7) is calculated using the following formula: In the formula, θ 1 represents the angle at which the first pressure tester deflects.
21. A servo motor frequency sweep test method according to claim 20, characterized in that: The deflection angle of the rocker arm (14) on the servo motor (2) under test toward the second pressure tester (8) is calculated using the following formula: In the formula, θ 2 represents the angle at which the second pressure tester deflects.
22. The servo motor frequency sweep test method according to claim 21, characterized in that: In step s6, the bandwidth of the servo motor (2) under test is calculated based on the sine wave command signal and the deflection angle of the rocker arm (14) on the servo motor (2) under test.
23. A servo motor frequency sweep test device, performing the test method as described in any one of claims 2-22, characterized in that: The test bench includes a test bench base (1), a first slide rail (6) and a second slide rail (5) arranged parallel to each other on both sides of the test bench base (1), a third slide rail (3) and a fourth slide rail (4) arranged parallel to each other between the first slide rail (6) and the second slide rail (5), a servo motor under test (2), a first pressure tester (7) arranged on the third slide rail (3), and a second pressure tester (8) arranged on the fourth slide rail (4); the servo motor under test (2) is vertically fixed to the front end of the second slide rail (5) and between the third slide rail (3) and the fourth slide rail (4) through a servo motor mounting fixture (13) on the test bench base (1), and a rocker arm (14) is fixedly connected to the upper surface of the servo motor under test (2) through the output shaft (15) of the servo motor under test, and the rocker arm (14) is located between the first pressure tester (7) and the second pressure tester (8); the third slide rail (3), the fourth slide rail (4), and the second slide rail (5) are arranged parallel to each other between the first slide rail (6) and the second slide rail (5), and the second slide rail (8) are arranged parallel to each other between the first slide rail (6) and the second slide rail (5), and the third slide rail (6) and the fourth slide rail (5) are arranged parallel to each other between the first slide rail (6) and the second slide rail (5), and the second slide rail (8 ... The servo motor under test (2) is perpendicular to the first slide rail (6) and the second slide rail (5); the first pressure tester (7) and the second pressure tester (8) both include a slider (9), a pressure sensor (10) and a spring (11). The pressure sensor (10) is fixedly connected to the surface of the slider (9) relative to the rocker arm (14). The spring (11) is fixedly connected to the pressure sensor (10). A spring sleeve (12) is provided on the outside of the spring (11); the slider (9) on the first pressure tester (7) slides on the third slide rail (3); the slider (9) on the second pressure tester (8) slides on the fourth slide rail (4). The position of the first pressure tester (7) on the third slide rail (3) and the second pressure tester (8) on the fourth slide rail (4) are determined by the set asymmetric linear load. The position of the third slide rail (3) and the fourth slide rail (4) are determined according to the set motion dead zone size.
24. The servo motor frequency sweep test device according to claim 1, characterized in that: A slider (9) is slidably connected to the first slide rail (6) and the second slide rail (5). The third slide rail (3) and the fourth slide rail (4) are clamped between the first slide rail (6) and the second slide rail (5) by the slider (9) on the first slide rail (6) and the second slide rail (5).
25. The servo motor frequency sweep test device according to claim 2, characterized in that: The first pressure tester (7) and the second pressure tester (8) are electrically connected to the test computer.
Citation Information
Patent Citations
Methods for obtaining Bode plots from swept frequency data using MATLAB
CN109472846B
Servo steering engine frequency band width test method and system based on constant load
CN121115711A
