A target tracking control method for an air floating platform
By installing an attitude adjustment actuator and attitude sensor on the air float platform, and using adaptive control and joint control technology, the control accuracy and speed problems of the air float simulation device under heavy loads are solved, achieving efficient target tracking.
Patent Information
- Application Number
- CN202410946989.9
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-16
- Publication Date
- 2024-11-05
- Estimated Expiration
- 2044-07-16
AI Technical Summary
When existing air float simulation devices are loaded with heavier or larger loads, they have poor control accuracy, long control time, and difficult control, making it impossible to achieve fast and accurate target tracking.
By installing a posture adjustment actuator and attitude sensor on the air float platform, using the camera to recognize the motion simulator, the attitude processor calculates the required target angular velocity, and drives the flywheel and the cold spray assembly for adaptive control or joint control, achieving finesse Control, use the PWM output pulse to control the solenoid valve switch for torque control.
High-precision control under heavy load conditions is achieved, control time is shortened, target tracking efficiency is improved, and the problem of the inability to achieve rapid maneuvering and insufficient power is solved.
Smart Images

Figure CN118502269B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of spacecraft ground semi-physical simulation, and in particular to a target tracking control method for an air floating platform. Background Art
[0002] With the rapid development of satellite technology, in order to ensure the effective operation of spacecraft in orbit, spacecraft requires ground physical simulation tests. Therefore, the construction of ground simulation test systems is an important guarantee for the development of space technology.
[0003] After a spacecraft is launched into space, it sometimes needs to adjust its attitude to perform related tasks, such as monitoring the status of a specific target and continuously tracking the target. This places very strict requirements on the attitude control system of the spacecraft, and the requirements for the flexibility, accuracy and maneuverability of the ground simulation system are also constantly increasing. Generally, for light spacecraft such as small satellites, attitude adjustment can be achieved with just a flywheel, and its control is relatively simple. However, for heavy-loaded spacecraft, the adjustment of the flywheel is too slow, and even the speed of the spacecraft attitude adjustment cannot keep up with the speed of the target, making it impossible to achieve the target tracking function.
[0004] In the existing technology of using air-floating platforms to simulate spacecraft on the ground, the control structure of flywheel + jet thruster is more common, but for target tracking simulation under large loads, there is no very suitable control method that can achieve fast and precise control.
[0005] For the three-dimensional physical simulation of spacecraft, the three-axis air floating table is difficult to control. Control decoupling can be used to first use a single-axis air floating table to achieve planar control simulation, and then use control synthesis to achieve three-dimensional control simulation of the spacecraft.
[0006] When the air-floating simulation device is equipped with a heavy or large load, the output torque control has the disadvantages of poor control accuracy, long control time, and difficulty in control due to factors such as large inertia and air damping. Summary of the invention
[0007] The present invention provides an air floating platform target tracking control method to solve the technical problems mentioned in the background technology.
[0008] To achieve the above object, the technical solution of the present invention is achieved as follows:
[0009] The present invention provides a control method for tracking a target on an air floating platform, comprising the following steps:
[0010] S1. After the camera on the air floating platform recognizes the motion simulator, the motion simulator starts to run at the set angular velocity, and the camera starts to track the motion simulator;
[0011] S2, after the attitude processor obtains the motion information of the motion simulator, it uses the algorithm to calculate the target angular velocity required for the air-floating platform to track the motion simulator, and then calculates the output torque according to the difference between the current attitude angular velocity of the air-floating platform and the target angular velocity;
[0012] S3, converting the output torque into a control quantity, determining the control strategy, and driving the flywheel and the cold spray assembly to perform adaptive control, joint control, or fine control on the air floating platform;
[0013] S4, judging whether the difference between the current attitude angular velocity of the air floating platform and the target angular velocity is within the set range, if yes, ending the control, if no, looping S2 to S4 until the difference between the current attitude angular velocity and the target angular velocity is within the set range.
[0014] Furthermore, the air flotation platform comprises:
[0015] The attitude adjustment actuator includes a flywheel and a cold spray assembly, wherein the cold spray assembly includes a controller, a gas storage bottle, a plurality of symmetrically arranged solenoid valves and a nozzle mounted on the solenoid valve, liquid nitrogen is stored in the gas storage bottle, and the controller uses PWM output pulses to control the switch of the solenoid valve, thereby opening and / or closing the nozzle on the solenoid valve for torque control;
[0016] Attitude sensors, including time sensors, star sensors, gyroscopes, accelerometers, and cameras;
[0017] The attitude processor is connected to the camera and is used to calculate the output data of the attitude sensor according to the PID algorithm, and control the attitude adjustment actuator according to the calculation result;
[0018] The motion simulator is used to simulate the target motion scene and transmit the motion information to the gesture processor.
[0019] Furthermore, the S2 specifically includes the following steps:
[0020] S21, after the attitude processor obtains the motion information and the output data of the attitude sensor, it calculates the damping of the air floating platform based on the obtained output data ;
[0021] S22, based on the damping of the air floating platform Calculate the moment of inertia of the air-floating platform ;
[0022] S23, based on the moment of inertia of the air floating platform And air floating platform damping Calculate the required output torque .
[0023] Furthermore, in S21, the damping of the air floating platform is calculated based on the acquired output data. The specific steps include:
[0024] S211, by adjusting the output torque of the flywheel, the air floating platform is operated at different set angular velocities for a period of time, and before each switching of the different set angular velocities, the air floating platform is allowed to operate stably, and then the angular velocity is switched, and the operating data of the flywheel and the air floating platform are recorded;
[0025] S212, according to the speed measured by the flywheel, calculate the angular momentum provided by the flywheel. Since only the flywheel and the air-floating platform damping are doing work during the operation of the air-floating platform in S211, it can be known that , due to the angular acceleration of the air-floating platform remain unchanged, that is ;so ;in is the moment of inertia of the air-floating platform, is the output torque of the flywheel;
[0026] Measure the flywheel speed increment , test time difference The damping is calculated as ,in is the moment of inertia of the flywheel, is the angular acceleration of the flywheel.
[0027] Furthermore, the S22 specifically includes the following steps:
[0028] S221, the flywheel runs at a set speed, so that the air-floating platform overcomes the resistance of the air-floating platform and the air resistance and enters a stable rotation state from a static state. During this process, the angular velocity difference of the rotation of the air-floating platform is recorded;
[0029] S222, based on the recorded angular velocity difference of the air-floating platform rotation and the damping of the air-floating platform And the energy conservation theorem, calculate the moment of inertia of the air floating platform .
[0030] Furthermore, the moment of inertia of the air floating platform The formula is as follows:
[0031] ;
[0032] in, It indicates the angular velocity difference of the air floating platform from acceleration to stable rotation.
[0033] Furthermore, the required output torque in S23 is The formula is as follows:
[0034] ;
[0035] In the formula, It represents the angular acceleration that the air-floating platform needs to reach. It is calculated by obtaining the difference between the current platform attitude angular velocity of the air-floating platform and the target angular velocity per unit time through the attitude sensor. The target angular velocity is calculated by the angular difference between the air-floating platform and the motion simulator.
[0036] Furthermore, the implementation of S3 is as follows:
[0037] First, determine the interval of the difference between the current angular velocity of the air-floating platform and the target angular velocity, and select the control mode autonomously according to the interval. The control modes include adaptive control, combined control and fine control. In adaptive control or combined control mode, the output torque is Calculate the number and direction of nozzles to be opened on the cold spray assembly, and output torque according to the required Adjust the PWM pulse duty cycle to achieve adaptive control or combined control.
[0038] Furthermore, the selection principles of the adaptive control, joint control and fine control in S31 are as follows:
[0039] If the angular velocity difference is In the interval, the control mode selects adaptive control. In this process, the cold spray component is used as the main output torque execution unit. Automatically control the number of nozzles to be opened on the cold spray assembly and the PWM duty cycle to adjust the torque; by controlling the forward and reverse solenoid valves to achieve the forward and reverse output torque, the target acceleration and deceleration can be tracked, thereby achieving adaptive control; Among them, Indicates the maximum angular velocity of the combined control of the cold spray assembly and the flywheel; represents the maximum angular velocity of the adaptive control of the cold spray assembly;
[0040] If the angular velocity difference is In the interval, the control mode selects joint control, during which the flywheel and the cold spray component are used for joint control; the flywheel is used to improve the control accuracy in this control stage and correct the control error caused by the instability of the output torque of the cold spray component; and / or the cold spray component will be controlled in this control stage, and when the flywheel speed is saturated, the cold spray component performs torque compensation when the flywheel is unloaded; wherein, Indicates the maximum angular velocity of the air-floating platform controlled by the flywheel;
[0041] If the angular velocity difference is In the interval, the control mode selects fine control, during which only the flywheel is used for control. Indicates the angular velocity difference at which control can be ended.
[0042] Furthermore, the , and The calculation formulas are as follows:
[0043] ;
[0044] ;
[0045] ;
[0046] Wherein, L1 represents the angular momentum of a single nozzle on the cold spray assembly; L0 is the angular momentum of the flywheel; and n represents the number of solenoid valves.
[0047] Furthermore, the The value is 0.1~0.3deg / s.
[0048] Beneficial effects of the present invention:
[0049] 1. Compared with the control method of the traditional air-floating simulation device, the present invention solves the problem that the single-axis air-floating simulation device cannot realize rapid maneuvering and is prone to insufficient power when carrying a heavy or large load;
[0050] 2. The present invention realizes the classification control of target tracking, which includes adaptive control, joint control and fine control, ensuring the accuracy and flexibility of control; among them, adaptive control is suitable for the case where the relative torque requirement is large and the angular velocity difference is When the torque demand is small and the angular velocity difference is Fine control is suitable for situations where the torque demand is very small and the angular velocity difference is In the case of It represents the maximum angular velocity of the air-floating platform controlled by the flywheel, is the maximum angular velocity of the combined control of the cold spray assembly and the flywheel, Maximum angular velocity for adaptive control of cold spray assembly;
[0051] 3. The present invention improves the cold spray output of the air floating platform and adopts PWM output pulse duty cycle to achieve precise control of the output torque;
[0052] 4. The present invention utilizes cold spray components and high-torque flywheels to increase the control load range, and achieves high-precision control under heavy-load conditions of the air-floating platform through adaptive combined control (including adaptive control and combined control), and also shortens the control time and improves the efficiency of target tracking. BRIEF DESCRIPTION OF THE DRAWINGS
[0053] Figure 1 is a control flow chart of the present invention;
[0054] Figure 2 is a detailed flow chart of S2 in the present invention;
[0055] Figure 3 is a detailed flow chart of S21 in the present invention;
[0056] Figure 4 is a detailed flow chart of S22 in the present invention;
[0057] Figure 5 This is the PID algorithm control block diagram. DETAILED DESCRIPTION
[0058] In order to facilitate the understanding of the present invention, the present invention will be described more fully below with reference to the relevant drawings. Preferred embodiments of the present invention are provided in the drawings. However, the present invention can be implemented in many other different forms and is not limited to the embodiments described herein. On the contrary, the purpose of providing these embodiments is to make the understanding of the disclosure of the present invention more thorough and comprehensive.
[0059] Unless otherwise defined, all technical and scientific terms used herein have the same meaning as those commonly understood by those skilled in the art to which the present invention belongs. The terms used herein in the specification of the present invention are only for the purpose of describing specific embodiments and are not intended to limit the present invention. The term "and / or" used herein includes any and all combinations of one or more of the related listed items.
[0060] Reference Figure 1 The present application provides a method for tracking and controlling an air floating platform target, comprising the following steps:
[0061] S1. After the camera on the air floating platform recognizes the motion simulator, the motion simulator starts to run at the set angular velocity, and the camera starts to track the motion simulator;
[0062] S2, after the attitude processor obtains the motion information of the motion simulator, it uses the algorithm to calculate the target angular velocity required for the air-floating platform to track the motion simulator, and then calculates the output torque according to the difference between the current attitude angular velocity of the air-floating platform and the target angular velocity;
[0063] S3, converting the output torque into a control quantity, determining the control strategy, and driving the flywheel and the cold spray assembly to perform adaptive control, joint control, or fine control on the air floating platform;
[0064] S4, judging whether the difference between the current angular velocity of the air floating platform and the target angular velocity is within the set range, if yes, ending the control, if no, looping S2 to S4 until the difference between the current angular velocity of the air floating platform and the target angular velocity is within the set range.
[0065] Compared with the traditional air-floating simulation device, the present invention solves the problem that the single-axis air-floating simulation device cannot realize rapid maneuvering and is prone to insufficient power when carrying a heavy or large load.
[0066] In some embodiments, the air flotation platform comprises:
[0067] The attitude adjustment actuator comprises a flywheel and a cold spray assembly, wherein the cold spray assembly comprises a controller, a gas storage cylinder, a plurality of symmetrically arranged solenoid valves and a nozzle mounted on the solenoid valve, liquid nitrogen is stored in the gas storage cylinder, and the controller uses PWM output pulses to control the switch of the solenoid valve, thereby opening and / or closing the nozzle on the solenoid valve for torque control; the number of the solenoid valves is n, n≥4, and the plurality of solenoid valves are distributed in positive and negative symmetry;
[0068] Attitude sensors include time sensors, star sensors, gyroscopes, accelerometers, and cameras; the camera is used to capture the target object and transmit the captured position information to the attitude processor;
[0069] The attitude processor uses a high-concurrency processing chip and is connected to the camera. It is used to calculate the output data of the attitude sensor according to the PID algorithm, and control the attitude adjustment actuator through the calculation results;
[0070] The motion simulator is used to simulate the target motion scene and transmit the motion information to the attitude processor. The motion simulator can simulate a series of motion states of the target object, such as acceleration from rest, constant speed running, deceleration to rest; the attitude data of the motion simulator can be obtained by the camera, or transmitted to the attitude processor by the device controlling the motion simulator. This design allows the motion simulator to obtain two input data, thereby allowing the motion simulator to obtain more accurate control input;
[0071] In the control process, the motion simulator controls the target object to run according to the set parameters, the camera identifies the target object, calculates the angle difference according to the target object's position at the center of the camera, and then calculates the compensation of the angle difference for the motion control of the air floating platform in the information processor of the attitude processor through the angle loop PID, that is, the angle difference compensation;
[0072] The input parameters of the angular velocity loop PID calculation are: the angular velocity information of the air-floating platform obtained by the gyroscope, the angular velocity of the motion simulator obtained by the camera, the angle of the motion simulator and the angle difference compensation calculated by the information processor in the attitude processor. The attitude controller in the attitude processor calculates the angular velocity difference and outputs the control torque through the angular velocity loop PID to determine the control mode. For details, please see Figure 5 ;
[0073] In some embodiments, the flywheel adopts a high-torque reaction flywheel, which has the advantages of large output torque, high precision, stable control, and long life.
[0074] In some embodiments, reference Figure 2 , S2 specifically includes the following steps:
[0075] S21, after the attitude processor obtains the motion information and the output data of the attitude sensor, it calculates the damping of the air floating platform based on the obtained output data When the air-floating platform carries a load with a large moment of inertia, the damping of the air-floating platform is relatively large, so the damping of the air-floating platform The calculation of cannot be ignored;
[0076] S22, based on the damping of the air floating platform Calculate the moment of inertia of the air-floating platform ;
[0077] S23, based on the moment of inertia of the air floating platform And air floating platform damping Calculate the required output torque .
[0078] Specifically, according to the motion data generated by the motion simulator, the rotational angular velocity of the target object (centered on the air-floating platform) can be known. The attitude sensor obtains the gyroscope attitude information to obtain the angular velocity of the air-floating platform, thereby obtaining the angular velocity required to achieve the target tracking state and the angular velocity difference of the air-floating platform, and calculating the torque required to be output.
[0079] At the same time, the camera can be used to capture the position changes of the target object to calculate the angle changes, thereby ensuring the accuracy of the target posture information.
[0080] In some embodiments, reference Figure 3 In S21, the damping M of the air-floating platform is calculated based on the output data obtained. 阻 The specific steps include:
[0081] S211, by adjusting the output torque of the flywheel, the air floating platform is operated at different set angular velocities for a period of time, and before each switching of the different set angular velocities, the air floating platform is allowed to operate stably, and then the angular velocity is switched, and the operating data of the flywheel and the air floating platform are recorded;
[0082] S213, according to the speed measured by the flywheel, calculate the angular momentum provided by the flywheel. Since only the flywheel and the air-floating platform damping are doing work during the operation of the air-floating platform in S211 and S212, it can be known that , due to the angular acceleration of the air-floating platform remain unchanged, that is ;so ;in is the moment of inertia of the air-floating platform, is the output torque of the flywheel;
[0083] Measure the flywheel speed increment , flywheel speed increment The unit is rpm (revolutions per minute), which needs to be converted to rad / s (radians per second) when performing calculations; and according to the test time difference The damping is calculated as ,in is the moment of inertia of the flywheel, is the angular acceleration of the flywheel.
[0084] In some embodiments, reference Figure 4 , S22 specifically includes the following steps:
[0085] S221, the flywheel runs at a set speed, so that the air floating platform overcomes the resistance of the air floating platform and the air resistance and enters a stable rotation state from a static state, the stable rotation state means that the angular velocity difference of the rotation of the air floating platform is within a set threshold value, during which the angular velocity difference of the rotation of the air floating platform is recorded;
[0086] S222, based on the recorded angular velocity difference of the air-floating platform rotation and the damping of the air-floating platform And the energy conservation theorem, calculate the moment of inertia of the air floating platform ;
[0087] Specifically, according to the law of conservation of energy, the combined force of the air-floating platform including damping is :
[0088] ;
[0089] in, ;
[0090] In summary, we can get: ;
[0091] in, It indicates the angular velocity difference of the air floating platform from acceleration to stable rotation.
[0092] In some embodiments, the required output torque in S23 The formula is as follows:
[0093] ;
[0094] in, It represents the angular acceleration that the air-floating platform needs to reach. It is calculated by obtaining the difference between the current platform attitude angular velocity of the air-floating platform and the target angular velocity per unit time through the attitude sensor. The target angular velocity is calculated by the angle difference between the air-floating platform and the motion simulator. The larger the angle between the air-floating platform and the motion simulator, the larger the target angular velocity of the air-floating platform is relative to the angular velocity of the motion simulator.
[0095] In some embodiments, S3 is implemented as follows:
[0096] First, determine the interval of the difference between the current angular velocity of the air-floating platform and the target angular velocity, and select the control mode autonomously according to the interval. The control modes include adaptive control, combined control and fine control. In adaptive control or combined control mode, the output torque is Calculate the number and direction of nozzles to be opened on the cold spray assembly, and output torque according to the required Adjust the PWM pulse duty cycle to achieve adaptive control or combined control.
[0097] The present invention realizes the classification control of target tracking and ensures the accuracy and flexibility of control.
[0098] In some embodiments, the selection principles of adaptive control, joint control and fine control in S31 are as follows:
[0099] If output torque is required Large and angular velocity difference In the interval, the control mode selects adaptive control. In this process, the cold spray component is used as the main output torque execution unit. Automatically control the number of nozzles to be opened on the cold spray assembly and the PWM duty cycle to adjust the torque; by controlling the forward and reverse solenoid valves to achieve the forward and reverse output torque, the target acceleration and deceleration can be tracked, thereby achieving adaptive control; Among them, Indicates the maximum angular velocity of the combined control of the cold spray assembly and the flywheel; represents the maximum angular velocity of the adaptive control of the cold spray assembly;
[0100] If the output torque Small and angular velocity difference In the interval, the control mode selects joint control, during which the flywheel and the cold spray component are used for joint control; the flywheel is used to improve the control accuracy in this control stage and correct the control error caused by the instability of the output torque of the cold spray component; and / or the cold spray component will be controlled in this control stage, and when the flywheel speed is saturated, the cold spray component performs torque compensation when the flywheel is unloaded; wherein, Indicates the maximum angular velocity of the air-floating platform controlled by the flywheel;
[0101] If the output torque Very small and the angular velocity difference is In the interval, the control mode selects fine control, during which only the flywheel is used for control. Indicates the angular velocity difference at which control can be ended.
[0102] The angular velocity difference is Within , it can be considered that the angular velocity has reached consistency, and the control can be ended. In this embodiment, The value is 0.2deg / s.
[0103] In the control stage of adaptive combined control (including adaptive control and combined control), the number of nozzles opened on the solenoid valve of the cold spray component is determined by the required output torque. Take the output torque of a cold spray assembly as an example, if the output torque is 2Nm, Between 0~2Nm, the cold spray component opens one nozzle for control, which can be adjusted according to the required output torque. Adjust the PWM pulse duty cycle, if output torque is required If it is greater than 2Nm, two nozzles are opened for control, and so on, thus realizing adaptive joint control of large torque and rapid maneuvering.
[0104] During joint control, the flywheel is responsible for improving control accuracy and correcting control errors caused by unstable output torque of the cold spray component; when the flywheel speed is almost saturated, the cold spray component can compensate and allow the flywheel to unload speed.
[0105] The invention improves the cold spray output of the air floating platform and adopts PWM output pulse duty ratio, thereby realizing accurate control of the output torque.
[0106] In some embodiments, , and The calculation formulas are as follows:
[0107] ;
[0108] ;
[0109] ;
[0110] Wherein, L1 represents the angular momentum of a single nozzle on the cold spray assembly; L0 is the angular momentum of the flywheel.
[0111] The following is an example of classification control:
[0112] First, the camera of the air-floating platform faces the target object and tracks the target object's acceleration from static to moving. The air-floating platform enters the adaptive control mode and uses the cold spray component for rapid tracking. The angular velocity difference reaches After reaching the target range, the air-floating platform enters the uniform speed state. The air-floating platform enters the joint control mode, using the cold spray component and the flywheel for control, and maintains the tracking state. When the angle of the air-floating platform approaches the target object and enters the deceleration state, the air-floating platform first enters the adaptive control mode, and the cold spray component sprays air in the reverse direction, outputs a reverse torque, and controls the air-floating platform to decelerate until the angular velocity difference is less than , and then enter the fine control mode; until the angular velocity difference is less than , maintain a relatively static state with the target, that is, complete the control process of target tracking.
[0113] The above example assumes that the motion state of the tracking target has not changed. If the motion state of the target object changes during tracking, the operating state of the air floating platform will also change accordingly after detection and calculation.
[0114] The present invention utilizes a cold spray assembly and a high-torque flywheel to increase the control load range, and realizes high-precision control under heavy-load conditions of an air-floating platform through adaptive combined control (including adaptive control and combined control), and also shortens the control time and improves the efficiency of target tracking.
[0115] The above is only a specific embodiment of the present invention, but the protection scope of the present invention is not limited thereto. Any technician familiar with the technical field can easily think of changes or substitutions within the technical scope disclosed by the present invention, which should be covered within the protection scope of the present invention. In addition, the technical solutions between the various embodiments of the present invention can be combined with each other, but it must be based on the ability of ordinary technicians in the field to implement. When the combination of technical solutions is contradictory or cannot be implemented, it should be considered that such a combination of technical solutions does not exist and is not within the protection scope of the present invention. Therefore, the protection scope of the present invention shall be based on the protection scope of the claims.
Claims
1. A method for tracking and controlling a target of an air floating platform, characterized in that: The steps include: S1. After the camera on the air floating platform recognizes the motion simulator, the motion simulator starts to run at the set angular velocity, and the camera starts to track the motion simulator; S2, after the attitude processor obtains the motion information of the motion simulator, it uses the algorithm to calculate the target angular velocity required for the air-floating platform to track the motion simulator, and then calculates the output torque according to the difference between the current attitude angular velocity of the air-floating platform and the target angular velocity; The S2 specifically includes the following steps: S21, after the attitude processor obtains the motion information and the output data of the attitude sensor, it calculates the damping M of the air floating platform based on the obtained output data 阻 ; S22, based on the damping M of the air floating platform 阻 Calculate the moment of inertia I of the air-floating platform 台 ; S23, based on the moment of inertia of the air floating platform I 台 And the air-floating platform damping M 阻 Calculate the required output torque M 输 ; In S21, the damping M of the air floating platform is calculated based on the acquired output data. 阻 The specific steps include: S211, by adjusting the output torque of the flywheel, the air floating platform is operated at different set angular velocities for a period of time, and before each switching of the different set angular velocities, the air floating platform is allowed to operate stably, and then the angular velocity is switched, and the operating data of the flywheel and the air floating platform are recorded; S212. Calculate the angular momentum provided by the flywheel based on the speed measured by the flywheel. Since only the flywheel and the air-floating platform damping are doing work during the operation of the air-floating platform in S211, it can be known that , due to the angular acceleration α of the air-floating platform 台 remains unchanged, that is, α 台 =0; so M 轮 =M 阻 ; where I 台 is the moment of inertia of the air-floating platform, M 轮 is the output torque of the flywheel; Measure the flywheel speed increment , test time difference The damping is calculated as , where I 轮 represents the moment of inertia of the flywheel, α 轮 represents the angular acceleration of the flywheel; S3, converting the output torque into a control quantity, determining the control strategy, and driving the flywheel and the cold spray assembly to perform adaptive control, joint control, or fine control on the air floating platform; S4, judging whether the difference between the current angular velocity of the air floating platform and the target angular velocity is within the set range, if yes, ending the control, if no, looping S2 to S4 until the difference between the current angular velocity of the air floating platform and the target angular velocity is within the set range.
2. The control method according to claim 1, characterized in that: The air flotation platform comprises: The attitude adjustment actuator includes a flywheel and a cold spray assembly, wherein the cold spray assembly includes a controller, a gas storage bottle, a plurality of symmetrically arranged solenoid valves, and a nozzle mounted on the solenoid valve. The controller uses PWM output pulses to control the switch of the solenoid valve, thereby opening and / or closing the nozzle on the solenoid valve for torque control. Attitude sensors, including time sensors, star sensors, gyroscopes, accelerometers, and cameras; The attitude processor is connected to the camera and is used to calculate the output data of the attitude sensor according to the PID algorithm, and control the attitude adjustment actuator according to the calculation result; The motion simulator is used to simulate the target motion scene and transmit the motion information to the gesture processor.
3. The control method according to claim 1, characterized in that: The S22 specifically includes the following steps: S221, the flywheel runs at a set speed, so that the air-floating platform overcomes the resistance of the air-floating platform and the air resistance and enters a stable rotation state from a static state. During this process, the angular velocity difference of the rotation of the air-floating platform is recorded; S222, based on the recorded angular velocity difference of the air-floating platform rotation and the damping M of the air-floating platform 阻 And the energy conservation theorem, the moment of inertia I of the air floating platform is calculated 台。 4. The control method according to claim 3, characterized in that: The moment of inertia of the air floating platform is 台 The formula is as follows: ; in, It indicates the angular velocity difference of the air floating platform from acceleration to stable rotation.
5. The control method according to claim 4, characterized in that: The required output torque M in S23 输 The formula is as follows: ; In the formula, α 台 It represents the angular acceleration that the air-floating platform needs to reach. It is calculated by obtaining the difference between the current angular velocity of the air-floating platform and the target angular velocity per unit time through the attitude sensor. The target angular velocity is calculated by the angular difference between the air-floating platform and the motion simulator.
6. The control method according to claim 4, characterized in that: The implementation of S3 is as follows: First, determine the interval of the difference between the current angular velocity of the air-floating platform and the target angular velocity, and select the control mode autonomously according to the interval. The control modes include adaptive control, combined control and fine control. In adaptive control or combined control mode, the output torque M is required. 输 Calculate the number and direction of nozzles to be opened on the cold spray assembly, and calculate the required output torque M 输 Adjust the PWM pulse duty cycle to achieve adaptive control or combined control.
7. The control method according to claim 6, characterized in that: The selection principles of adaptive control, joint control and fine control in S31 are as follows: If the angular velocity difference is within the interval of ω1~ω2, the control mode selects adaptive control. In this process, the cold spray component is used as the main output torque execution unit. 输 Automatically control the number of nozzles on the cold spray assembly that need to be opened and the PWM duty cycle to adjust the torque; by controlling the forward and reverse solenoid valves to achieve the forward and reverse output torque, the target acceleration and deceleration can be tracked, thereby achieving adaptive control; where ω1 represents the maximum angular velocity of the cold spray assembly and the flywheel combined control; ω2 represents the maximum angular velocity of the cold spray assembly adaptive control; If the angular velocity difference is within the interval of ω0~ω1, the control mode selects joint control, during which the flywheel and the cold spray assembly are used for joint control; the flywheel is used to improve the control accuracy in this control stage and correct the control error caused by the instability of the output torque of the cold spray assembly; and / or the cold spray assembly will be controlled in this control stage, and when the flywheel speed is saturated, the cold spray assembly will perform torque compensation when the flywheel is unloaded; wherein ω0 represents the maximum angular velocity of the flywheel controlling the air flotation platform; If the angular velocity difference is in the interval of β~ω0, the control mode selects fine control, during which only the flywheel is used for control, where β represents the angular velocity difference at which the control can be ended.
8. The control method according to claim 7, characterized in that: The calculation formulas of ω0, ω1 and ω2 are as follows: ; ; ; Wherein, L1 represents the angular momentum of a single nozzle on the cold spray assembly; L0 is the angular momentum of the flywheel; and n represents the number of solenoid valves.
