Disturbance active control device

Through the electric servo drive and closed-loop control system, the precise power disturbance control of the liquid storage tank is achieved, which solves the problem of insufficient accuracy in the liquid shaking simulation test in the prior art and the rollover in the transportation of the liquid tank truck, and improves the power disturbance of the liquid shaking Control accuracy and security.

CN119063940APending Publication Date: 2024-12-03BEIJING INST OF STRUCTURE & ENVIRONMENT ENG +1
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411183424.6
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-27
Publication Date
2024-12-03

AI Technical Summary

Technical Problem

In the ground liquid management test, it is difficult to accurately simulate the interference of liquid fuel shaking on spacecraft attitude control, and frequent overturning accidents caused by liquid shaking during transportation of liquid tankers. The existing disturbance excitation control accuracy is not high, and the form is single. .

Method used

The electric servo driver and closed-loop control system are adopted to achieve precise power disturbance control of the liquid storage tank through the displacement sensor, acceleration sensor and camera. Combined with interpolation algorithm and servo motor drive, high-precision power application and feedback are achieved.

Benefits of technology

It improves the accuracy of liquid shaking disturbance power control, can effectively simulate the liquid shaking in the liquid storage tank, and reduces the risk of liquid tanker overturning and the interference of spacecraft attitude control.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119063940A_ABST
    Figure CN119063940A_ABST
Patent Text Reader

Abstract

The invention relates to an active disturbance control device which is characterized in that a servo driver is arranged on the front side of a to-be-tested simulation storage tank, a camera is arranged on the rear side, a laser displacement sensor is arranged on the left side, and a servo motor is arranged on the right side; the servo driver and the camera are symmetrical about the position of the simulation storage box and are fixed on the device mounting plate; and the laser displacement sensor and the servo motor are symmetrical about the position and are fixed on the device mounting plate. The disturbance active control device is driven by an electric servo and applies accurate disturbance force to a tested liquid storage tank in the process of a ground liquid shaking test; a displacement sensor and a grating ruler are used as closed-loop control feedback, and the displacement and disturbance force control precision is improved through a closed-loop algorithm and an interpolation algorithm; interference force applied to the liquid storage tank is obtained in real time through the acceleration sensor, and the change rule of the liquid level under the interference force is recorded through the camera.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to an active disturbance control device, which is used for active disturbance control of a ground liquid management test and belongs to the technical field of dynamics tests. Background Art

[0002] In order to improve the carrying capacity, the liquid fuel carried by the spacecraft accounts for a considerable part of its total weight. When the spacecraft is performing orbit transfer, attitude maneuvers, rendezvous and docking, separation, and engine startup and shutdown, the liquid fuel in the tank will slosh, which has a significant impact on the attitude control and stability of the spacecraft. Many spacecraft launch failures are caused by liquid fuel sloshing. How to suppress the interference of fuel sloshing on the attitude control of the spacecraft is a difficult problem.

[0003] In addition, tank trucks are widely used in road transportation of liquid goods. However, when the tank is not fully loaded, due to braking, steering and other operations during driving, the liquid in the tank will slosh and exert sloshing force on the transport vehicle. Improper operation will cause traffic accidents such as rollover of the tank truck. Therefore, it is very necessary to apply disturbance excitation control in the liquid sloshing simulation test on the ground.

[0004] By applying disturbance excitation to the test liquid, the sloshing of liquid fuel caused by attitude control in the liquid tank is simulated. Usually, the disturbance excitation of ground liquid sloshing research is mainly achieved by spring application or push-pull table, and the application of disturbance load is completed by changing the spring stiffness and compression stroke and push-pull displacement and frequency. This disturbance load loading method has low accuracy and a single form of disturbance load. Summary of the invention

[0005] 1. Technical issues to be resolved

[0006] In view of the deficiencies of the above-mentioned prior art, the present invention proposes an active disturbance control device, which adopts an electric servo drive to apply precise disturbance force to the test liquid tank during the ground liquid sloshing test; uses a displacement sensor and a grating scale as closed-loop control feedback, and improves the displacement and disturbance force control accuracy through a closed-loop algorithm and an interpolation algorithm; obtains the disturbance force applied to the liquid tank in real time through an acceleration sensor, and records the change pattern of the liquid level under the disturbance force through a camera, which can effectively solve the key technical problems of precise control of the disturbance force of ground liquid sloshing.

[0007] (II) Technical solution

[0008] A disturbance active control device is provided. A servo driver is arranged at the front side of a simulated tank to be tested, a camera is arranged at the rear side, a laser displacement sensor is arranged at the left side, and a servo motor is arranged at the right side. The simulated tank is centrally arranged in the center of a device mounting plate. The servo driver and the camera are symmetrically positioned with respect to the simulated tank and are both fixed to the device mounting plate. The laser displacement sensor and the servo motor are symmetrically positioned and are both fixed to the device mounting plate. The disturbance active control device also includes a controller with an electrical interface.

[0009] The servo motor is fixed on the device mounting plate through a supporting frame, and a ball screw, photoelectric switch I, photoelectric switch II, photoelectric switch III and a simulated tank mounting adapter plate are also fixed on the supporting frame; one end of the ball screw is connected to the servo motor drive, and the other end is fixedly connected to the simulated tank mounting adapter plate, and a simulated tank is fixed on the simulated tank mounting adapter plate; the electric switch I, photoelectric switch II and photoelectric switch III are arranged in sequence along one side of the ball screw from the end close to the simulated tank to the end away from the simulated tank; the grating ruler is arranged on the other side of the ball screw.

[0010] The servo motor power supply signal line is connected to the servo driver output electrical interface, photoelectric switch I, photoelectric switch II, and photoelectric switch III are connected to the servo driver digital interface, and the servo driver is connected to the network port in the controller's electrical interface through the EtherCAT bus; the acceleration sensor and laser displacement sensor are connected to the analog input interface on the controller's electrical interface through the signal line; the grating ruler is connected to the analog input interface of the servo driver through the signal line.

[0011] The camera lens is flush with the liquid level in the simulated tank.

[0012] The disturbance test method of the active disturbance control device comprises the following steps:

[0013] S1. Preparation of the entire disturbance test system including the disturbance active control device;

[0014] S2. Powering on the active disturbance control device;

[0015] S3. Connect the laser displacement sensor, acceleration sensor and controller;

[0016] S4. Select the linear perturbation mode or the sinusoidal periodic perturbation mode;

[0017] S5. Determine whether the standard is met according to the corresponding disturbance mode;

[0018] S6. If the standard is met, the disturbance test is terminated. If the standard is not met, the test returns to the corresponding disturbance mode and continues to work until the standard is met.

[0019] In step S2, the controller sends a control command to the servo driver, and the servo driver moves the ball screw to its midpoint position. At this time, the photoelectric switch II is triggered, and after being triggered, the corresponding signal is fed back to the servo driver. The servo driver sends the status to the controller through the EtherCAT bus.

[0020] In step S5, if the linear disturbance mode is selected, the target position and speed are set first, and then the disturbance mode is started. The acceleration sensor measures the overload value, the grating ruler and the laser displacement sensor measure the current position, and finally it is determined whether the current position meets the standard.

[0021] In step S5, if the sinusoidal periodic disturbance mode is selected, the amplitude and frequency are set first, and then the disturbance mode is started. The acceleration sensor measures the overload value, the grating ruler and the laser displacement sensor measure the current position, and finally it is determined whether the period meets the standard.

[0022] In step S6, if the standard is not met, return to the corresponding disturbance mode, restart the disturbance mode again, and continue with subsequent steps until the standard is met.

[0023] A disturbance motion trajectory curve is set in the controller. After startup, the controller sends a control instruction to the servo driver. The servo driver controls the servo motor to rotate according to the instruction. The servo motor drives the ball screw to rotate, so that the simulated tank on the simulated tank installation adapter plate performs linear motion. The grating ruler feeds back the motion position of the simulated tank to the servo driver, the laser displacement sensor feeds back the motion position of the simulated tank to the controller, and the acceleration sensor feeds back the simulated tank overload to the controller. The servo driver and the controller perform closed-loop control with the grating ruler feedback value and the laser displacement feedback value respectively until the disturbance active control device completes the target trajectory, and the camera records the liquid image in the liquid tank under the whole disturbance.

[0024] (III) Beneficial effects

[0025] The active disturbance control device of the present invention has the following beneficial effects:

[0026] 1. The present invention adopts an electric servo control method, which controls the servo motor to drive the ball screw to convert the servo motor rotation into linear motion, thereby realizing lateral disturbance of the simulated tank, and obtaining the actual positions of the disturbance device and the test piece through a grating ruler and a laser displacement sensor, respectively, and improving the disturbance accuracy through a closed-loop algorithm.

[0027] 2. The disturbance active control device of the present invention can accurately obtain the disturbance acceleration through the acceleration sensor installed on the time mounting surface, thereby calculating the disturbance force applied to the simulated tank, and record and store the liquid level state of the liquid in the simulated tank under the action of the disturbance force through a camera.

[0028] 3. The present invention adopts electric servo drive technology and is configured with servo motors, ball screws and other accessories of different specifications according to modular design to meet the disturbance test under different loads of the tested products. BRIEF DESCRIPTION OF THE DRAWINGS

[0029] Figure 1 A top view of a disturbance active control device of the present invention

[0030] Figure 2 Side view of a disturbance active control device of the present invention

[0031] Figure 3 A disturbance test method control flow chart of a disturbance active control device of the present invention Figure 1-2 In the figure, the corresponding reference numerals include:

[0032] 1-servo motor, 2-acceleration sensor, 3-simulated tank, 4-camera, 5-laser displacement sensor, 6-support frame, 7-servo driver, 8-photoelectric switch I, 9-photoelectric switch II, 10-photoelectric switch III, 11-controller, 12-electrical interface, 13-ball screw, 14-grating ruler; 15-simulated tank installation adapter plate, 16-device installation plate. DETAILED DESCRIPTION

[0033] See also Figure 1-2 The present invention provides an active disturbance control device. A servo driver 7 is provided on the front side of a simulated tank 3 to be tested, a camera 4 is provided on the rear side, a laser displacement sensor 5 is provided on the left side, and a servo motor 1 is provided on the right side. The simulated tank 3 is centrally arranged in the center of a device mounting plate 16. The servo driver 7 and the camera 4 are symmetrically positioned with respect to the simulated tank 3 and are both fixed to the device mounting plate 16. The laser displacement sensor 5 and the servo motor 1 are symmetrically positioned and are both fixed to the device mounting plate 16. The active disturbance control device also includes a controller 11 with an electrical interface 12.

[0034] The servo motor 1 is fixed to the device mounting plate 16 through the support frame 6, and the support frame 6 is also fixed with a ball screw 13, a photoelectric switch I8, a photoelectric switch II9, a photoelectric switch III10 and a simulated tank mounting adapter plate 15; one end of the ball screw 13 is drivingly connected to the servo motor 1, and the other end is fixedly connected to the simulated tank mounting adapter plate 15, and the simulated tank 3 is fixed to the simulated tank mounting adapter plate 15; the electric switch I8, the photoelectric switch II9 and the photoelectric switch III10 are arranged in sequence along one side of the ball screw 13 from the end close to the simulated tank 3 to the end away from the simulated tank 3; the grating ruler 14 is arranged on the other side of the ball screw 13.

[0035] The power supply signal line of the servo motor 1 is connected to the output electrical interface of the servo driver 7, the photoelectric switch I8, the photoelectric switch II9, and the photoelectric switch III10 are connected to the digital interface of the servo driver 7, and the servo driver 7 is connected to the network port in the electrical interface 12 of the controller 11 through the EtherCAT bus; the acceleration sensor 2 and the laser displacement sensor 5 are connected to the analog input interface on the electrical interface 12 of the controller 11 through the signal line; the grating ruler 14 is connected to the analog input interface of the servo driver 7 through the signal line.

[0036] The camera lens 4 is flush with the liquid level in the simulated tank 3 .

[0037] See also Figure 3 A disturbance test method of an active disturbance control device of the present invention comprises the following steps:

[0038] S1. Preparation of the entire disturbance test system including the disturbance active control device;

[0039] S2. Powering on the active disturbance control device;

[0040] S3. Connect the laser displacement sensor 5, the acceleration sensor 2 and the controller 11;

[0041] S4. Select the linear perturbation mode or the sinusoidal periodic perturbation mode;

[0042] S5. Determine whether the standard is met according to the corresponding disturbance mode;

[0043] S6. If the standard is met, the disturbance test is terminated. If the standard is not met, the test returns to the corresponding disturbance mode and continues to work until the standard is met.

[0044] In step S2, the controller 12 sends a control instruction to the servo driver 7, and the servo driver 7 moves the ball screw 13 to its midpoint position. At this time, the photoelectric switch II9 is ​​triggered, and after being triggered, the corresponding signal is fed back to the servo driver 7. The servo driver 7 sends the status to the controller 12 through the EtherCAT bus.

[0045] In step S5, if the linear disturbance mode is selected, the target position and speed are set first, and then the disturbance mode is started. The acceleration sensor 2 measures the overload value, the grating ruler 14 and the laser displacement sensor 5 measure the current position, and finally it is determined whether the current position meets the standard.

[0046] In step S5, if the sinusoidal periodic disturbance mode is selected, the amplitude and frequency are set first, and then the disturbance mode is started. The acceleration sensor 2 measures the overload value, the grating ruler 14 and the laser displacement sensor 5 measure the current position, and finally it is determined whether the period meets the standard.

[0047] In step S6, if the standard is not met, return to the corresponding disturbance mode, restart the disturbance mode again, and continue with subsequent steps until the standard is met.

[0048] A disturbance motion trajectory curve is set in the controller 11. After startup, the controller 11 sends a control instruction to the servo driver 7. The servo driver 7 controls the servo motor 1 to rotate according to the instruction. The servo motor 1 drives the ball screw 13 to rotate, so that the simulated tank 3 on the simulated tank mounting adapter plate 15 performs linear motion; the grating scale 14 feeds back the motion position of the simulated tank 3 to the servo driver 7, the laser displacement sensor 5 feeds back the motion position of the simulated tank 3 to the controller 11, and the acceleration sensor 2 feeds back the overload of the simulated tank 3 to the controller 11; the servo driver 7 and the controller 11 perform closed-loop control with the grating scale feedback value and the laser displacement feedback value respectively until the disturbance active control device moves to complete the target trajectory, and at the same time, the camera 4 records the liquid image in the liquid tank 3 under the whole disturbance.

Claims

1. A disturbance active control device, characterized in that: A servo driver (7) is provided on the front side of a simulated tank (3) to be tested, a camera (4) is provided on the rear side, a laser displacement sensor (5) is provided on the left side, and a servo motor (1) is provided on the right side. The simulated tank (3) is centrally arranged in the center of a device mounting plate (16). The servo driver (7) and the camera (4) are symmetrically positioned with respect to the simulated tank (3) and are both fixed to the device mounting plate (16). The laser displacement sensor (5) and the servo motor (1) are symmetrically positioned and are both fixed to the device mounting plate (16). The active disturbance control device further includes a controller (11) with an electrical interface (12).

2. The active disturbance control device according to claim 1, characterized in that: The servo motor (1) is fixed to the device mounting plate (16) through a support frame (6). A ball screw (13), a photoelectric switch I (8), a photoelectric switch II (9), a photoelectric switch III (10) and a simulated tank mounting adapter plate (15) are also fixed to the support frame (6). One end of the ball screw (13) is connected to the servo motor (1) for driving, and the other end is fixedly connected to the simulated tank mounting adapter plate (15). The simulated tank (3) is fixed to the simulated tank mounting adapter plate (15). The electric switch I (8), the photoelectric switch II (9) and the photoelectric switch III (10) are arranged in sequence along one side of the ball screw (13) from the end close to the simulated tank (3) to the end away from the simulated tank (3). The grating ruler (14) is arranged on the other side of the ball screw (13).

3. The active disturbance control device according to claim 2, characterized in that: The power supply signal line of the servo motor (1) is connected to the output electrical interface of the servo driver (7); the photoelectric switch I (8), the photoelectric switch II (9), and the photoelectric switch III (10) are connected to the digital interface of the servo driver (7); the servo driver (7) is connected to the network port in the electrical interface (12) of the controller (11) via the EtherCAT bus; the acceleration sensor (2) and the laser displacement sensor (5) are connected to the analog input interface on the electrical interface (12) of the controller (11) via the signal line; and the grating ruler (14) is connected to the analog input interface of the servo driver (7) via the signal line.

4. The active disturbance control device according to claim 3, characterized in that: The camera (4) lens is flush with the liquid level in the simulated tank (3).

5. The disturbance test method using the active disturbance control device according to claim 4 is characterized in that: The following steps are involved: S1. Preparation of the entire disturbance test system including the active disturbance control device; S2. The active disturbance control device is powered on; S3. Connecting the laser displacement sensor (5), the acceleration sensor (2) and the controller (11); S4. Select linear perturbation mode or sinusoidal periodic perturbation mode; S5. Determine whether the standard is met based on the corresponding disturbance pattern; S6. If the standard is met, end the disturbance test. If the standard is not met, return to the corresponding disturbance mode and continue working until the standard is met.

6. The disturbance test method according to claim 5, characterized in that: In step S2, the controller (12) sends a control instruction to the servo driver (7), and the servo driver (7) moves the ball screw (13) to its midpoint position. At this time, the photoelectric switch II (9) is triggered, and after being triggered, the corresponding signal is fed back to the servo driver (7). The servo driver (7) sends the status to the controller (12) through the EtherCAT bus.

7. The disturbance test method according to claim 6, characterized in that: In step S5, if the linear disturbance mode is selected, the target position and speed are set first, and then the disturbance mode is started. The acceleration sensor (2) measures the overload value, the grating ruler (14) and the laser displacement sensor (5) measure the current position, and finally it is determined whether the current position meets the standard.

8. The disturbance test method according to claim 6, characterized in that: In step S5, if the sinusoidal periodic disturbance mode is selected, the amplitude and frequency are set first, and then the disturbance mode is started. The acceleration sensor (2) measures the overload value, the grating ruler (14) and the laser displacement sensor (5) measure the current position, and finally it is determined whether the period meets the standard.

9. The disturbance test method according to claim 7 or 8, characterized in that: In step S6, if the standard is not met, return to the corresponding disturbance mode, restart the disturbance mode again, and continue with subsequent steps until the standard is met.

10. The disturbance test method according to claim 9, characterized in that: A disturbance motion trajectory curve is set in the controller (11). After startup, the controller (11) sends a control instruction to the servo driver (7). The servo driver (7) controls the servo motor (1) to rotate according to the instruction. The servo motor (1) drives the ball screw (13) to rotate, so that the simulated tank (3) on the simulated tank mounting adapter plate (15) performs linear motion; the grating ruler (14) feeds back the motion position of the simulated tank (3) to the servo driver (7), the laser displacement sensor (5) feeds back the motion position of the simulated tank (3) to the controller (11), and the acceleration sensor (2) feeds back the overload of the simulated tank (3) to the controller (11); the servo driver (7) and the controller (11) respectively perform closed-loop control with the grating ruler feedback value and the laser displacement feedback value until the disturbance active control device completes the target trajectory, and at the same time, the camera (4) records the liquid image in the liquid tank (3) under the whole disturbance.