Precision leveling method for unbalanced moment of pitch axis of two-axis antenna
By recording and processing the current information output from the pitch motor driver, combining the load mass information, the distribution characteristics of the pitch axis friction torque and unbalanced torque are obtained, and the counterweight block is adjusted on the antenna pitch mechanism, the efficiency in the traditional leveling method is solved The problem of low and low accuracy achieves high-precision pitch axis unbalanced torque leveling.
Patent Information
- Application Number
- CN202410493445.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-04-23
- Publication Date
- 2024-11-15
AI Technical Summary
The traditional two-axis antenna pitch axis unbalanced torque leveling method is low in efficiency and low in accuracy. It is greatly affected by the pitch axis friction torque, making it difficult to achieve high-precision leveling.
By recording the current information output from the pitch motor driver, combining the load mass information, using data interpolation, screening and fitting, the distribution characteristics of friction torque and unbalanced torque are obtained, and the counterweight blocks are added or reduced on the pitch mechanism to achieve high Precision leveling.
High-precision leveling of pitch axis imbalance torque is achieved, debugging efficiency and system comprehensive performance are improved, and leveling process is simplified.
Smart Images

Figure CN118970451A_ABST
Abstract
Description
Technical Field
[0001] The invention discloses radar technology, and in particular relates to a method for precisely leveling an unbalanced moment of a two-axis antenna pitch axis. Background Art
[0002] Two-axis antennas usually adopt a structure in which the azimuth axis and the pitch axis are orthogonal, and are widely used in the fields of communication, testing, and detection. In order to meet the requirements of high dynamic performance, high reliability, and high maintainability of the system, it is necessary to level the unbalanced torque of the antenna's pitch axis. Traditional unbalanced torque leveling usually adopts the trial-and-error method, which checks the stability of the antenna's pitch axis at several angle positions evenly distributed within the pitch axis motion range, and repeatedly adjusts the weight of the counterweight until the antenna pitch axis remains stationary at all the above angle positions. The traditional trial-and-error method has low debugging efficiency, and due to the influence of the friction torque of the pitch axis, the leveling accuracy is not high, which affects the overall performance of the system. How to improve the experimental test method and overcome the influence of the friction torque of the pitch axis is the key to improving the leveling accuracy and debugging efficiency of the unbalanced torque of the pitch axis. Summary of the invention
[0003] The purpose of the present invention is to propose a method for precise leveling of the unbalanced torque of the pitch axis of a two-axis antenna. Based on the distribution characteristics of the friction torque and unbalanced torque of the pitch axis at different positions and under different working conditions, the current information output by the pitch axis motor driver during movement under different working conditions is recorded, combined with information such as the load mass of the pitch axis, to achieve high-precision leveling of the unbalanced torque of the pitch axis.
[0004] The technical solution to achieve the purpose of the present invention is: a method for precise leveling of unbalanced moment of a two-axis antenna pitch axis, the steps are as follows:
[0005] The pitch motor driver drives the antenna pitch angle to reciprocate, and records the antenna pitch angle and the current information output by the pitch motor driver. The data collected in one reciprocating motion is defined as a group. Through data interpolation, screening, and smoothing processes, a group of test data containing the friction torque and unbalanced torque information of the pitch axis is obtained;
[0006] Based on the angle direction of the center of gravity, the counterweight blocks are added or reduced on the pitch mechanism to achieve high-precision leveling of the unbalanced moment of the pitch axis.
[0007] Furthermore, the pitch motor driver drives the antenna pitch angle to reciprocate, records the antenna pitch angle and the current information output by the pitch motor driver, and the data collected once for the reciprocating motion is defined as a group. Through the data interpolation, screening, and smoothing process, a group of test data containing the friction torque and unbalanced torque information of the pitch axis is obtained. The specific method is as follows:
[0008] The pitch motor driver is set to drive the antenna pitch angle to reciprocate between the lower limit angle and the upper limit angle at a uniform speed of 1° / s, and the antenna pitch angle and the current information output by the pitch motor driver are recorded at a frequency of 50 Hz. The data collected in one reciprocating motion is defined as a group, and a total of 5 groups of data are recorded. Through preprocessing processes such as data interpolation, screening, and smoothing, a group of test data containing the friction torque and unbalanced torque information of the pitch axis is obtained. The motor output torque corresponding to each pitch angle value during the uniform motion of the motor from the lower limit to the upper limit is expressed by T m-DU Indicates that the motor output torque corresponding to each pitch angle value when moving in the reverse direction is T m-UD express.
[0009] Furthermore, the unbalanced moment T Bias =-(T m-DU +T m-UD ) / 2, friction torque T f =(T m-DU -T m-UD ) / 2, and the distribution characteristics of unbalanced torque and friction torque are obtained by data fitting. Bias-θ =T Bias-max· sin(θ+θ cog -90°), where T Bias-max represents the maximum unbalanced moment, θ cog It represents the angle between the vertical line from the center of gravity of the antenna pitch axis load to the pitch axis and the central axis of the antenna. θ represents the antenna elevation angle. T Bias-θ It represents the unbalanced moment when the antenna elevation angle is θ.
[0010] Furthermore, the counterweight blocks added or reduced on the pitch mechanism based on the center of gravity angle direction can achieve high-precision leveling of the unbalanced moment of the pitch axis, and the specific method is as follows:
[0011] If the installation position of the counterweight block is adjustable, cog Add counterweight in the +180° direction, or cog Reduce the counterweight in the direction, and set the distance between the center of gravity of the counterweight and the pitch axis to be L cw , then the weight of the counterweight block increased or decreased is m cw =T Bias-max / (g · L cw ), that is, to achieve high-precision leveling of the unbalanced torque of the pitch axis.
[0012] Furthermore, the counterweight blocks added or reduced on the pitch mechanism based on the center of gravity angle direction can achieve high-precision leveling of the unbalanced moment of the pitch axis, and the specific method is as follows:
[0013] If the installation position of the counterweight is fixed, assume that after the counterweight is installed, the angle between the vertical line from the center of gravity of the counterweight to the pitch axis and the central axis of the antenna is θ cw , the distance between the center of gravity of the counterweight and the pitch axis is L cw , the load mass of the pitch axis is m El , the distance from the pitch axis is L cog At this time, by adjusting the mass m of the counterweight cw , so that the center of gravity of the pitch mechanism after adjustment is located on the line between the center of gravity of the pitch mechanism before adjustment and the center of gravity of the counterweight block, with θ cw ,θ cog , L cw , L cog 、m cw and m El The value of the cosine theorem is used to calculate the mass m of the counterweight required when the center of gravity of the adjusted pitch mechanism is located at any position on the line connecting the two centers of gravity. cw , and realize approximate leveling of the unbalanced moment of the pitch axis according to actual needs.
[0014] Compared with the prior art, the present invention has the following significant advantages: (1) the output current information of the motor driver when the antenna pitch axis reciprocates within a specified range is used as the original data, and the acquisition method is simple and easy to implement; (2) the original test data is used, after data preprocessing, and the data fitting method is adopted, and the distribution characteristics of the unbalanced torque and the friction torque can be obtained through simple calculations; (3) the obtained unbalanced torque distribution characteristics are combined with information such as the load mass of the pitch axis to calculate information such as the mass and installation position of the counterweight block, so as to guide the implementation of the leveling work, and quickly achieve high-precision leveling of the unbalanced torque of the pitch axis. BRIEF DESCRIPTION OF THE DRAWINGS
[0015] Figure 1 It is a schematic diagram of unbalanced moment leveling of a two-axis antenna in the present invention;
[0016] Figure 2 It is a flow chart of the pitch axis unbalanced moment leveling in the present invention.
[0017] Figure 3 It is a schematic diagram of approximate leveling of the unbalanced moment of the pitch axis in the present invention. DETAILED DESCRIPTION
[0018] In order to make the purpose, technical solution and advantages of the present application more clearly understood, the present application is further described in detail below in conjunction with the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are only used to explain the present application and are not used to limit the present application.
[0019] The present invention discloses a method for precise leveling of unbalanced torque of a pitch axis of a two-axis antenna. The method is based on the distribution characteristics of the friction torque and unbalanced torque of the pitch axis at different positions and under different working conditions. The method records the current information output by the pitch axis motor driver during the movement under different working conditions and combines the information such as the load mass of the pitch axis to achieve high-precision leveling of the unbalanced torque of the pitch axis.
[0020] The pitch motor driver is set to drive the antenna pitch angle to reciprocate between the lower limit angle and the upper limit angle at a uniform speed of 1° / s, and the antenna pitch angle and the current information output by the pitch motor driver are recorded at a frequency of 50 Hz. The data collected in one reciprocating motion is defined as a group, and a total of 5 groups of data are recorded. Through preprocessing processes such as data interpolation, screening, and smoothing, a group of test data containing the friction torque and unbalanced torque information of the pitch axis is obtained. The motor output torque corresponding to each pitch angle value during the uniform motion of the motor from the lower limit to the upper limit is expressed by T m-DU Indicates that the motor output torque corresponding to each pitch angle value when moving in the reverse direction is T m-UD express.
[0021] Without complicated measurement and calibration, the unbalanced moment T can be obtained by using the pre-processed test data. Bias =-(T m-DU +T m-UD ) / 2, friction torque T f =(T m-DU -T m-UD ) / 2, using data fitting and simple calculation, the distribution characteristics of unbalanced torque and friction torque can be obtained.
[0022] T Bias-θ =T Bias-max· sin(θ+θ cog -90°), where T Bias-max represents the maximum unbalanced moment, θ cog Indicates the angle direction of the center of gravity.
[0023] If the antenna structure allows, the pitch mechanism θ cog Add counterweight in the +180° direction, or cog Reduce the counterweight in the direction. If the distance between the center of gravity of the counterweight and the pitch axis is L cw , then the weight of the counterweight block increased or decreased is m cw =T Bias-max / (g · L cw ), which can realize high-precision leveling of the unbalanced moment of the pitch axis.
[0024] If the counterweight is installed in a fixed position, or cannot be adjusted in the above specified direction, assume that the center of gravity of the counterweight is at θ after installation.cw Angular direction, the distance from the pitch axis is L cw , the load mass of the pitch axis is m El , the distance from the pitch axis is L cog At this time, by adjusting the mass m of the counterweight cw , the center of gravity of the pitch mechanism after adjustment can be located on the line between the center of gravity of the pitch mechanism before adjustment and the center of gravity of the counterweight block, and the cw ,θ cog , L cw , L cog 、m cw and m El The value of the cosine theorem can be used to calculate the mass m of the counterweight required when the center of gravity of the pitch mechanism after adjustment is located at any position on the line connecting the two centers of gravity. cw , and realize approximate leveling of the unbalanced moment of the pitch axis according to actual needs.
[0025] Example
[0026] In order to verify the effectiveness of the scheme of the present invention, the following experimental design was carried out.
[0027] 1. Adjust the antenna base to a horizontal state, ensuring that the azimuth axis is perpendicular to the horizontal plane. From the structure of the two-axis antenna, it can be seen that the pitch axis is parallel to the horizontal plane. Define the output current of the pitch motor driving the antenna upward as positive, and the corresponding opposite direction as negative; the torque of the unbalanced torque of the pitch axis driving the antenna upward is positive, and the corresponding opposite direction is negative; the direction of the friction torque when the antenna moves downward is positive, and the corresponding opposite direction is negative. Define that when the antenna points horizontally forward, the pitch angle is 0°, upward is positive, and downward is negative.
[0028] 2. Considering the test safety and data sample size, and avoiding the system from creeping at low speed, the pitch motor driver is set to drive the antenna pitch angle to reciprocate between the lower limit angle and the upper limit angle at a uniform speed of 1° / s, and the antenna pitch angle and the current information output by the pitch motor driver are recorded at a frequency of 50 Hz. The data collected in one reciprocating motion is defined as a group, and a total of 5 groups of data are recorded.
[0029] 3. Generate an angle array sequence between the lower limit and the upper limit of the pitch angle at intervals of 0.1°. Based on the 5 sets of test data in step 2, calculate the driver output current value of the antenna corresponding to each angle in the array sequence during the operation from the lower limit to the upper limit by linear interpolation method. A total of 5 sets of new data can be generated.
[0030] 4. From the five new data sets consisting of the pitch angle values and driver output current values generated in step 3, it can be seen that each pitch angle value in the angle array sequence corresponds to a different driver output current value during the five measurements. The two current values with the largest deviation from the mean in the five measurements are eliminated, and the remaining three current measurement values are averaged. Then, the obtained current mean is multiplied by the motor torque coefficient to obtain the corresponding output torque, whose value corresponds to each pitch angle value in the angle array sequence. Finally, a set of pre-processed experimental test data consisting of pitch angle values and motor output torque values is obtained.
[0031] 5. Use the polynomial fitting method to smooth and fit the data obtained in step 4, and use the fitted motor output torque data to replace the original data to obtain the motor output torque corresponding to each pitch angle value during the uniform motion from the lower limit to the upper limit. Use T m-DU express.
[0032] 6. Based on the data recorded during the antenna's movement from the upper limit to the lower limit in step 2, use the data processing method in steps 3 to 5 to obtain the motor output torque corresponding to each pitch angle value during the motor's uniform motion from the upper limit to the lower limit, and use T m-UD express.
[0033] 7. In step 2, when the antenna pitch angle moves at a constant speed of 1° / s, in different movement directions, corresponding to the same pitch angle, the pitch axis friction torque T f Equal in magnitude and opposite in direction, unbalanced moment T Bias The magnitudes are equal and the directions are the same. Based on the torque direction defined in step 1, it can be seen that when the antenna pitch axis moves from bottom to top, the torque balance equation is T m-DU +T Bias -T f =0; when the antenna pitch axis moves from top to bottom, the torque balance equation is T m-UD +T Bias +T f =0.
[0034] 8. From the torque balance equation under the two working conditions in step 7, we can get the unbalanced torque T Bias =-(T m-DU +T m-UD ) / 2, friction torque T f =(T m-DU -T m-UD ) / 2.
[0035] 9. If the load mass of the pitch axis is m El , when the pitch angle is 0°, the center of gravity is at θ cog Angular direction, the vertical distance from the pitch axis is L cog, the gravitational acceleration is g, it can be seen that when the antenna elevation angle is θ, the corresponding unbalanced torque is T Bias-θ =m El· g · L cog ·sin(θ+θ cog -90°). The maximum unbalanced moment is recorded as T Bias-max , then T Bias-θ =T Bias-max· sin(θ+θ cog -90°).
[0036] 10. From the expression of unbalanced torque in step 9, it can be known that when testing, the corresponding T in the motion range between the lower limit and the upper limit of the pitch angle is Bias-θ When there is a maximum or minimum value in the value, θ can be directly obtained cog and T Bias-max If there is a maximum value, and the corresponding antenna elevation angle is θ max , then θ max +θ cog -90°=90°, that is θ cog =180°-θ max ; Similarly, if there is a minimum value, and the corresponding antenna elevation angle is θ min , then θ min +θ cog -90°=-90°, that is, θ cog =-θ min ; Maximum unbalanced moment T Bias-max It can be a maximum or minimum absolute value.
[0037] 11. When testing, the corresponding T in the range of motion between the lower limit and the upper limit of the pitch angle Bias-θ When there is no maximum or minimum value in the value, but there is a zero point, let T Bias-θ When it is zero, the corresponding antenna elevation angle is θ zero , then it is necessary to determine the unbalanced moment T when the pitch angle moves from bottom to top near the zero point Bias-θ The trend of change, if T Bias-θ From positive to negative, then θ zero +θ cog -90°=-180°, that is, θ cog =-90°-θ zero Similarly, if T Bias-θ From negative to positive, then θ zero +θ cog -90°=0°, that is, θ cog =90°-θ zero ; The obtained θ cog Substitute the value into the unbalanced moment T in step 9Bias-θ In the expression of Bias-max An unknown parameter can be obtained by using test data T Bias , by curve fitting, we can obtain T Bias-max Numeric value.
[0038] 12. Otherwise, from step 9, when the antenna elevation angle is θ, the corresponding unbalanced moment T Bias-θ The expression contains T Bias-max and θ cog Two unknown parameters can be obtained using test data T Bias , by curve fitting, we can obtain T Bias-max and θ cog The numerical value of .
[0039] 13. From the above steps, we can get T Bias-max and θ cog After the value of , if the installation position of the counterweight block is adjustable, the pitch mechanism θ cog Add counterweight in the +180° direction, or cog Reduce the counterweight in the direction. If the distance between the center of gravity of the counterweight and the pitch axis is L cw , then the weight of the counterweight block increased or decreased is m cw =T Bias-max / (g · L cw ). By adjusting the counterweight, the unbalanced moment of the antenna pitch axis can be leveled.
[0040] 14. If the counterweight is fixed in position, or cannot be adjusted in the direction specified in step 13, assume that after the counterweight is installed, the angle between the vertical line from the center of gravity of the counterweight to the pitch axis and the central axis of the antenna is θ. cw , the distance between the center of gravity of the counterweight and the pitch axis is L cw At this time, by adjusting the mass m of the counterweight cw , the center of gravity of the pitch mechanism after adjustment can be located on the line between the center of gravity of the pitch mechanism before adjustment and the center of gravity of the counterweight block, and the cw ,θ cog , L cw , L cog 、m cw and m El The value of the cosine theorem can be used to calculate the mass m of the counterweight required when the center of gravity of the pitch mechanism after adjustment is located at any position on the line connecting the two centers of gravity. cw , and realize approximate leveling of the unbalanced moment of the pitch axis according to actual needs.
[0041] The technical features of the above embodiments may be combined arbitrarily. To make the description concise, not all possible combinations of the technical features in the above embodiments are described. However, as long as there is no contradiction in the combination of these technical features, they should be considered to be within the scope of this specification.
[0042] The above-described embodiments only express several implementation methods of the present application, and the descriptions thereof are relatively specific and detailed, but they cannot be understood as limiting the scope of the present application. It should be pointed out that, for a person of ordinary skill in the art, several variations and improvements can be made without departing from the concept of the present application, and these all belong to the protection scope of the present application. Therefore, the protection scope of the present application shall be subject to the attached claims.
Claims
1. A method for precise leveling of unbalanced moment of a two-axis antenna pitch axis, characterized in that: Here are the steps: The pitch motor driver drives the antenna pitch angle to reciprocate, and records the antenna pitch angle and the current information output by the pitch motor driver. The data collected in one reciprocating motion is defined as a group. Through data interpolation, screening, and smoothing processes, a group of test data containing the friction torque and unbalanced torque information of the pitch axis is obtained; Based on the angle direction of the center of gravity, the counterweight blocks are added or reduced on the pitch mechanism to achieve high-precision leveling of the unbalanced moment of the pitch axis.
2. The method for precise leveling of unbalanced moment of the pitch axis of a two-axis antenna according to claim 1, characterized in that: The pitch motor driver drives the antenna pitch angle to reciprocate, records the antenna pitch angle and the current information output by the pitch motor driver, and the data collected once in the reciprocating motion is defined as a group. Through the data interpolation, screening, and smoothing process, a group of test data containing the friction torque and unbalanced torque information of the pitch axis is obtained. The specific method is as follows: The pitch motor driver is set to drive the antenna pitch angle to reciprocate between the lower limit angle and the upper limit angle at a uniform speed of 1° / s, and the antenna pitch angle and the current information output by the pitch motor driver are recorded at a frequency of 50 Hz. The data collected in one reciprocating motion is defined as a group, and a total of 5 groups of data are recorded. Through preprocessing processes such as data interpolation, screening, and smoothing, a group of test data containing the friction torque and unbalanced torque information of the pitch axis is obtained. The motor output torque corresponding to each pitch angle value during the uniform motion of the motor from the lower limit to the upper limit is expressed by T m-DU Indicates that the motor output torque corresponding to each pitch angle value when moving in the reverse direction is T m-UD express.
3. The method for precise leveling of unbalanced moment of the pitch axis of a two-axis antenna according to claim 2, characterized in that: Unbalanced moment T Bias =-(T m-DU +T m-UD ) / 2, friction torque T f =(T m-DU -T m-UD ) / 2, and the distribution characteristics of unbalanced torque and friction torque are obtained by data fitting. Bias-θ =T Bias-max· sin(θ+θ cog -90°), where T Bias-max represents the maximum unbalanced moment, θ cog It represents the angle between the vertical line from the center of gravity of the antenna pitch axis load to the pitch axis and the central axis of the antenna. θ represents the antenna elevation angle. T Bias-θ It represents the unbalanced moment when the antenna elevation angle is θ.
4. The method for precise leveling of unbalanced moment of the pitch axis of a two-axis antenna according to claim 3 is characterized in that: The method of adding or reducing the counterweight blocks on the pitch mechanism based on the center of gravity angle direction to achieve high-precision leveling of the unbalanced moment of the pitch axis is as follows: If the installation position of the counterweight block is adjustable, cog Add counterweight in the +180° direction, or cog Reduce the counterweight in the direction, and set the distance between the center of gravity of the counterweight and the pitch axis to be L cw , then the weight of the counterweight block increased or decreased is m cw =T Bias-max / (g · L cw ), that is, to achieve high-precision leveling of the unbalanced torque of the pitch axis.
5. The method for precise leveling of unbalanced moment of the pitch axis of a two-axis antenna according to claim 3, characterized in that: The method of adding or reducing the counterweight blocks on the pitch mechanism based on the center of gravity angle direction to achieve high-precision leveling of the unbalanced moment of the pitch axis is as follows: If the installation position of the counterweight is fixed, assume that after the counterweight is installed, the angle between the vertical line from the center of gravity of the counterweight to the pitch axis and the central axis of the antenna is θ cw , the distance between the center of gravity of the counterweight and the pitch axis is L cw , the load mass of the pitch axis is m El , the distance from the pitch axis is L cog At this time, by adjusting the mass m of the counterweight cw , so that the center of gravity of the pitch mechanism after adjustment is located on the line between the center of gravity of the pitch mechanism before adjustment and the center of gravity of the counterweight block, with θ cw ,θ cog , L cw , L cog 、m cw and m El The value of the cosine theorem is used to calculate the mass m of the counterweight required when the center of gravity of the adjusted pitch mechanism is located at any position on the line connecting the two centers of gravity. cw , and realize approximate leveling of the unbalanced moment of the pitch axis according to actual needs.
Citation Information
Patent Citations
Estimation and compensation method for unbalanced moment of aerial remote sensing inertially stabilized platform
CN101709975A
Compensation method of unbalanced disturbance torque of photoelectric tracking system on inclined platform
CN103823481A
High-precision servo control system and method for pitching motion of two-dimensional turntable under load eccentricity
CN111258337A
Configurable gravity balancing device with adjustable torque
CN111322353A
Two-axis two-frame airborne photoelectric platform azimuth and pitch axis balancing method and system
CN112378583A
