A method for identifying the centroid position of the pitch load of a radar servo system
By recording motor current data in the radar servo system and using the torque balance equation, the problem of center of mass identification of pitch load is solved, and the accurate identification of center of mass position in the radar servo system is achieved, simplifying the calculation and improving the accuracy of system performance evaluation is achieved. sex.
Patent Information
- Application Number
- CN202211178705.3
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-09-27
- Publication Date
- 2024-11-26
- Estimated Expiration
- 2042-09-27
AI Technical Summary
The prior art is difficult to accurately identify the center of the pitch load in radar servo systems, which makes it difficult to evaluate and confirm the impact of gravity imbalanced loads, affecting system performance and engineering design.
The motor drives the pitch load continuously forward and reverse rotation, record the motor current data, and use the moment balance equation to determine the center of mass position angle and distance of the pitch load, and combine the current-moment coefficient and gravity acceleration constant to establish a rectangular coordinate system to determine the center of mass position.
This method simplifies the calculation and reduces the calculation amount. It is easy to identify the position of the load centroid through the forward and reverse motion of pitch forward and reverse motion, and is suitable for practical applications.
Smart Images

Figure CN115639854B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to a method for identifying the mass center position of a load, and more specifically, to a method for identifying the mass center position of a pitch load of a radar servo system. Background Art
[0002] The load composition of the radar servo system includes inertial load, wind load, friction load, etc. In addition, since the center of gravity of the pitch load (radar antenna and the rotating part of the pitch mechanism) is usually not on its rotation axis, this structural feature determines that the pitch branch also includes a gravity imbalance load. The existence of gravity imbalance loads causes the pitch motor to need a higher power output to achieve load balance in a certain operating range and in a certain direction of movement, which has an adverse effect on the selection of motors in the engineering design stage of the servo system and the debugging of system performance in the engineering implementation stage. For large radar servo systems, this effect is more obvious.
[0003] Theoretically, during the engineering design phase of the servo system, the center of mass position of the pitch load can be obtained through simulation calculation by technical means, and the mass of the pitch load can be adjusted (increased) accordingly, so that the center of mass position of the load falls to or is as close to the rotation axis as possible, so that the gravity imbalance load is zero or close to zero. The disadvantage of this method is that it may cause the indicators of the drive motor to increase, but the advantage is that it can ensure the effect of engineering implementation.
[0004] In fact, the actual state of the load mass and its distribution characteristics will deviate from the design indicators to a certain extent, and there will be errors in the simulation calculation. This means that even if the engineering design is carried out according to the above method, the impact of the gravity unbalanced load still needs to be evaluated and confirmed during the engineering implementation stage, that is, the position of the center of mass of the pitch load needs to be identified. Summary of the invention
[0005] An object of the present invention is to provide a method for identifying the centroid position of a pitch load of a radar servo system.
[0006] In order to achieve the above object, the present invention adopts the following technical solutions:
[0007] A method for identifying the centroid position of a pitch load of a radar servo system, wherein the radar servo system comprises a pitch axis, a motor and a pitch load, wherein the motor drives the pitch load to perform rotational motion around the pitch axis, and the method comprises
[0008] The motor drives the pitch load to rotate continuously in the forward direction and in the reverse direction respectively;
[0009] When the pitch load rotates continuously in the forward direction and continuously in the reverse direction, the pitch load position angle and the forward motor current data and the reverse motor current data corresponding to the angle are recorded respectively;
[0010] The position angle of the center of mass of the pitch load is determined according to the changing trend of the forward motor current data and the reverse motor current data with the angle.
[0011] Preferably, the method comprises obtaining the distance of the center of mass position of the pitching load by using the moment balance equation of the pitching load.
[0012] Preferably, the method includes defining the normal direction of the pitch load as the X axis, the rotation center of the pitch axis as the coordinate origin O, establishing an XOY rectangular coordinate system, and the position of the pitch load centroid includes the distance from the pitch load centroid G to the origin O, and the angle θ between the line segment OG between the centroid G and the origin O and the positive direction of the X axis 0 , 0°→90° is forward rotation movement, and 90°→0° is reverse rotation movement.
[0013] Preferably, the method further comprises determining the positive angle θ of the pitch load mass center according to the following steps: 0
[0014] Let f(θ) = I + (θ)+I-(θ), let the derivative of function f(θ) be f′(θ),
[0015] When f(θ) decreases monotonically and passes through zero, if f(θ A )=0, then θ 0 =90°-θ A ;
[0016] When f(θ) decreases first and then increases to reach a minimum value, if f′(θ B )=0, then θ 0 =180°-θ B ;
[0017] When f(θ) increases monotonically and passes through zero, if f(θ C )=0, then θ 0 =270°-θ C ;
[0018] When f(θ) increases first and then decreases to reach a maximum value, if f′(θ D )=0, then θ 0 =360°-θ D ,
[0019] Among them I + (θ) is the motor current when the pitch load moves forward to position θ,
[0020] I-(θ) is the motor current when the pitch load moves negatively to position θ.
[0021] Preferably, the method further comprises determining the distance L from the center of mass of the pitch load to the origin according to the following formula:
[0022]
[0023] Where K I is the current-torque coefficient, m is the load mass, g is the gravitational acceleration constant,
[0024] θ E ∈[0°,90°] and satisfies cos(θ E +θ 0 )≠0,
[0025] Among them I + (θ E ) is the forward motion of the pitch load to an angle θ E The motor current at
[0026] I-(θ E ) is the pitch load moving negatively to an angle θ E The motor current at .
[0027] Preferably, the pitching load does not include wind load and inertia load.
[0028] Preferably, the pitching load includes a friction load and a gravity imbalance load.
[0029] Preferably, the method further includes the moment balance equation when the pitch load moves in the forward and reverse directions being:
[0030]
[0031] Among them, M J (θ) is the input torque associated with the load position θ;
[0032] M G (θ) is the gravity unbalanced load moment associated with the load position θ;
[0033] M f is the friction load torque.
[0034] Preferably, the method further includes the moment balance equation when the pitch load moves in the forward and reverse directions being:
[0035]
[0036] Where K I is the current-torque coefficient, m is the load mass, and g is the gravitational acceleration constant;
[0037] I + (θ) is the motor current when the pitch load moves forward to angle θ;
[0038] I-(θ) is the motor current when the pitch load moves negatively to an angle of θ;
[0039] θ 0 is the angle between the line segment OG between the center of mass G and the origin O and the positive direction of the X-axis;
[0040] L is the distance from the center of mass of the pitch load to the origin.
[0041] Preferably, the functional relationship between the pitch load position, load mass, motor current, current-torque coefficient and load center of mass position parameter is:
[0042]
[0043] Where K I is the current-torque coefficient, m is the load mass, and g is the gravitational acceleration constant;
[0044] I + (θ) is the motor current when the pitch load moves forward to position θ;
[0045] I-(θ) is the motor current when the pitch load moves negatively to position θ;
[0046] θ 0 is the angle between the line segment OG between the center of mass G and the origin O and the positive direction of the X-axis;
[0047] L is the distance from the center of mass of the pitch load to the origin.
[0048] The beneficial effects of the present invention are as follows:
[0049] The invention takes the moment balance equation during forward and reverse pitch motion as the starting point, and completes the identification by combining the motor current data easily obtained during forward and reverse pitch motion with the inherent physical parameters of the radar servo system. The method has a simple algorithm, a small amount of calculation, and is convenient for practical application. BRIEF DESCRIPTION OF THE DRAWINGS
[0050] The specific implementation modes of the present invention will be further described in detail below in conjunction with the accompanying drawings.
[0051] Figure 1 A flow chart showing a method for identifying the centroid position of a pitch load of a radar servo system according to an embodiment of the present invention is shown.
[0052] Figure 2 The positional relationship between the pitch load mass center G and the pitch load when the pitch position angle of the present invention is 0° is shown.
[0053] Figure 3 The positional relationship between the pitch load mass center G and the pitch load when the pitch position angle of the present invention is 90° is shown.
[0054] Figure 4 The positional relationship between the pitch load mass center G and the pitch load when the pitch position angle is θ according to the present invention is shown. DETAILED DESCRIPTION
[0055] In order to more clearly illustrate the present invention, the present invention is further described below in conjunction with preferred embodiments and accompanying drawings. Similar components in the accompanying drawings are represented by the same reference numerals. It should be understood by those skilled in the art that the content specifically described below is illustrative rather than restrictive, and should not be used to limit the scope of protection of the present invention.
[0056] The embodiment of the present invention provides a method for identifying the centroid position of a pitch load of a radar servo system. Figure 1 As shown,
[0057] The radar servo system includes a pitch axis, a motor and a pitch load, wherein the motor drives the pitch load to perform rotational motion around the pitch axis.
[0058] The method comprises the steps of driving the pitch load with a motor to rotate forward and reverse continuously respectively;
[0059] When the pitch load rotates continuously in the forward direction and continuously in the reverse direction, the pitch load position angle and the forward motor current data and the reverse motor current data corresponding to the angle are recorded respectively;
[0060] The position angle of the center of mass of the pitch load is determined according to the changing trend of the forward motor current data and the reverse motor current data with the angle.
[0061] The pitch load mass center position distance is obtained by using the moment balance equation of the pitch load according to the determined position angle of the pitch load mass center.
[0062] S1: Define pitch load and load moment
[0063] The present invention is implemented in an indoor or outdoor windless environment, and does not need to generate acceleration or deceleration motion, and the pitch load does not contain wind load and inertia load.
[0064] The pitch load includes friction load and gravity unbalance load. The load torque includes friction load torque, gravity unbalance load torque and input torque. The friction load torque is a constant, denoted by M. f ;The gravity unbalanced load moment and input moment are related to the load position;
[0065] Gravity unbalanced load moment M G The expression of (θ) is
[0066] M G (θ) = mgLcos(θ + θ 0 ) (1)
[0067] In formula (1), M J(θ) is the input torque associated with the load position θ, m is the load mass, θ is the load position, g is the gravitational acceleration constant, and I(θ) is the motor current.
[0068] Input torque M J (θ), using the motor current I(θ) and the current-torque coefficient K I It means that the expression is
[0069] M J (θ) = K I I(θ) (2)
[0070] In formula (2), M G (θ) is the gravity unbalanced load torque associated with the load position θ, and the current-torque coefficient K I is a constant and the motor current I(θ) is a measurable variable that is related to the load position θ.
[0071] S2: Establish an XOY rectangular coordinate system with the normal direction of the pitch load as the X axis and the rotation center of the pitch axis as the coordinate origin O. Define the distance from the center of mass G of the pitch load to point O as L, and the angle between the line segment OG between the center of mass G and the origin O and the positive direction of the X axis as θ 0 (0°≤θ 0 <360°).
[0072] In the XOY rectangular coordinate system, the distance L of the pitch load center of mass and the angle θ of the pitch load center of mass 0 The two parameters can reflect the position of the center of mass G of the pitching load.
[0073] Assume that the pitch load can continuously rotate forward and reverse around the pitch axis in the range of 0° to 90°, 0°→90° is the forward rotation movement, and 90°→0° is the reverse rotation movement. Figure 1 It shows the position relationship between the pitch load mass center G and the pitch load when the pitch load position angle is 0°; Figure 2 It shows the position relationship between the pitch load mass center G and the pitch load when the pitch load position angle is 90°; Figure 3 The figure shows the positional relationship between the pitch load mass center G and the pitch load when the pitch load position angle is any angle θ (0°≤θ≤90°).
[0074] S3: Determine the moment balance equations for forward and reverse rotational motion of the pitch load
[0075] For the unbalanced moment of gravity M G (θ) and friction torque M f , define the moment that makes the pitch load produce a positive rotational motion (0°→90°) as positive, and vice versa as negative, and list the moment balance equations for positive and reverse rotational motions:
[0076]
[0077] Input torque M J (θ) is positively related to the motor current I(θ), and the current that causes the pitch load to rotate in the positive direction (0°→90°) is defined as positive, and the current that causes the pitch load to rotate in the positive direction (0°→90°) is defined as negative; the input torque M J The direction of (θ) depends on the positive or negative of the motor current I(θ).
[0078] According to equations (1), (2), and (3), the moment balance equations for the forward and reverse rotational motions of the pitch load are obtained as follows:
[0079]
[0080] Where K I is the current-torque coefficient, m is the load mass, and g is the gravitational acceleration constant;
[0081] I + (θ) is the motor current when the pitch load moves forward to an angle of θ;
[0082] I - (θ) is the motor current when the pitch load moves negatively to an angle of θ;
[0083] θ 0 is the angle between the line segment OG between the center of mass G and the origin O and the positive direction of the X-axis;
[0084] L is the distance from the center of mass of the pitch load to the origin.
[0085] S4: determining the functional relationship between the load position, load mass, motor current, current-torque coefficient and load center of mass position parameters of the pitch load according to the torque balance equation during the forward rotational motion and reverse rotational motion of the pitch load;
[0086] From formula (4), the functional relationship between the load position, load mass, motor current, current-torque coefficient and load center of mass position parameters of the pitch load is obtained as follows:
[0087]
[0088] In formula (5), K I is the current-torque coefficient, m is the load mass, and g is the gravitational acceleration constant;
[0089] I + (θ) is the motor current when the pitch load moves forward to position θ;
[0090] I-(θ) is the motor current when the pitch load moves negatively to position θ;
[0091] θ 0is the angle between the line segment OG between the center of mass G and the origin O and the positive direction of the X-axis;
[0092] L is the distance from the center of mass of the pitch load to the origin.
[0093] A specific embodiment:
[0094] A radar servo system is constructed, which includes a pitch axis, a motor and a pitch load. The motor drives the pitch load to rotate around the pitch axis. The motor drives the pitch load to rotate continuously in a forward direction and continuously in a reverse direction.
[0095] Establish an XOY rectangular coordinate system with the normal direction of the pitch load as the X axis and the rotation center of the pitch axis as the coordinate origin O. Define the distance from the center of mass G of the pitch load to the origin O as L, and the angle between the line segment OG between the center of mass G and the origin O and the positive direction of the X axis as θ 0 (0°≤θ 0 <360°), the pitch load rotates continuously in the positive and negative directions around the pitch axis in the range of 0° to 90°, 0°→90° is the positive rotation movement, and 90°→0° is the negative rotation movement.
[0096] When the pitch load continuously rotates forward and reverse, the motor current I is recorded as the motor current I when the pitch load moves forward to position θ. + (θ) and the data of the motor current I-(θ) when the pitch load moves negatively to position θ.
[0097] According to the recorded motor current I when the pitch load moves forward to position θ + (θ) and the motor current I-(θ) when the pitch load moves negatively to position θ to determine the position angle of the center of mass of the pitch load;
[0098] Let f(θ) = I + (θ)+I-(θ), let the derivative of function f(θ) be f′(θ), and from formula (5) we can see that the monotonicity of f(θ) is the same as cos(θ+θ 0 ), when θ∈[0°,90°], its monotonicity characteristics have only the following four types: monotonically decreasing and passing through zero; decreasing first and then increasing with a minimum; monotonically increasing and passing through zero; increasing first and then decreasing with a maximum
[0099] When f(θ) decreases monotonically and passes through zero, if f(θ A )=0, then θ 0 =90°-θ A ;
[0100] When f(θ) decreases first and then increases to reach a minimum value, if f′(θ B )=0, then θ 0 =180°-θ B ;
[0101] When f(θ) increases monotonically and passes through zero, if f(θ C )=0, then θ 0 =270°-θ C ;
[0102] When f(θ) increases first and then decreases to reach a maximum value, if f′(θ D )=0, then θ 0 =360°-θ D .
[0103] According to the determined pitch load mass center position angle and using the pitch load moment balance equation, the pitch load mass center position distance L is obtained.
[0104] From formula (5), we can get
[0105]
[0106] Any θ E ∈[0°,90°] and satisfies cos(θ E +θ 0 )≠0, get the distance from the center of mass of the pitch load to the origin
[0107]
[0108] Where K I is the current-torque coefficient, m is the load mass, g is the gravitational acceleration constant, I + (θ E ) is the forward motion of the pitch load to an angle θ E The motor current at this time, I-(θ E ) is the pitch load moving negatively to an angle θ E The motor current at .
[0109] According to the obtained pitch load center of mass angle θ 0 The distance L from the center of mass of the pitch load is used to determine the position of the center of mass G of the pitch load in the XOY rectangular coordinate system.
[0110] The invention takes the moment balance equation during forward and reverse pitch motion as the starting point, and completes the identification by combining the motor current data easily obtained during forward and reverse pitch motion with the inherent physical parameters of the radar servo system. The method has a simple algorithm, a small amount of calculation, and is convenient for practical application.
[0111] In the description of the present invention, it should be noted that relational terms such as first and second, etc. are only used to distinguish one entity or operation from another entity or operation, and do not necessarily require or imply any such actual relationship or order between these entities or operations. Moreover, the terms "comprises", "comprising" or any other variants thereof are intended to cover non-exclusive inclusion, so that a process, method, article or device including a series of elements includes not only those elements, but also other elements not explicitly listed, or also includes elements inherent to such process, method, article or device. In the absence of further restrictions, an element defined by the statement "comprising a ..." does not exclude the presence of other identical elements in the process, method, article or device including the element.
[0112] Obviously, the above embodiments of the present invention are merely examples for clearly illustrating the present invention, and are not limitations on the implementation methods of the present invention. For ordinary technicians in the relevant field, other different forms of changes or modifications can be made based on the above description. It is impossible to list all the implementation methods here. All obvious changes or modifications derived from the technical solution of the present invention are still within the protection scope of the present invention.
Claims
1. A method for identifying the centroid position of a pitch load of a radar servo system, characterized in that: The radar servo system includes a pitch axis, a motor and a pitch load, wherein the motor drives the pitch load to perform rotational motion around the pitch axis. The method includes: The motor drives the pitch load to rotate continuously in the forward direction and in the reverse direction respectively; When the pitch load rotates continuously in the forward direction and continuously in the reverse direction, the pitch load position angle and the forward motor current data and the reverse motor current data corresponding to the angle are recorded respectively; Determine the position angle of the mass center of the pitch load according to the changing trend of the forward motor current data and the reverse motor current data with the angle; The distance of the center of mass position of the pitching load is obtained by using the moment balance equation of the pitching load; Define the normal direction of the pitch load as the X-axis, the rotation center of the pitch axis as the coordinate origin O, and establish an XOY rectangular coordinate system. The position of the pitch load center of mass includes the distance from the pitch load center of mass G to the origin O, and the angle θ0 between the center of mass G and the origin O and the positive direction of the X-axis. 0°→90° is a positive rotation movement, and 90°→0° is a reverse rotation movement. Determine the positive angle θ0 of the pitch load center of mass as follows: Let f(θ) = I + (θ)+I - (θ), let the derivative of function f(θ) be f′(θ), When f(θ) decreases monotonically and passes through zero, if f(θ A )=0, then θ0=90°-θ A ; When f(θ) decreases first and then increases to reach a minimum value, if f′(θ B )=0, then θ0=180°-θ B ; When f(θ) increases monotonically and passes through zero, if f(θ C )=0, then θ0=270°-θ C ; When f(θ) increases first and then decreases to reach a maximum value, if f′(θ D )=0, then θ0=360°-θ D , Among them I + (θ) is the motor current when the pitch load moves forward to position θ, I - (θ) is the motor current when the pitch load moves negatively to position θ; Determine the distance L from the center of mass of the pitch load to the origin according to the following formula Where K I is the current-torque coefficient, m is the load mass, g is the gravitational acceleration constant, θ E ∈[0°, 90°] and satisfies cos(θ E + θ0) ≠ 0, Among them I + (θ E ) is the forward motion of the pitch load to an angle θ E The motor current at I - (θ E ) is the pitch load moving negatively to an angle θ E The motor current at .
2. The method for identifying the centroid position of the pitch load of a radar servo system according to claim 1, characterized in that: The pitching load does not include wind load and inertia load.
3. The method for identifying the centroid position of the pitch load of a radar servo system according to claim 1, characterized in that: The pitching load includes a friction load and a gravity imbalance load.
4. The method for identifying the center of mass position of the pitch load of the radar servo system according to claim 1, characterized in that: The method further includes the moment balance equations for the forward and reverse motions of the pitch load: Among them, M J (θ) is the input torque associated with the load position θ; M G (θ) is the gravity unbalanced load moment associated with the load position θ; M f is the friction load torque.
5. The method for identifying the centroid position of the pitch load of the radar servo system according to claim 4, characterized in that: The method further includes the moment balance equations for the forward and reverse motions of the pitch load: Where K I is the current-torque coefficient, m is the load mass, and g is the gravitational acceleration constant; I + (θ) is the motor current when the pitch load moves forward to angle θ; I - (θ) is the motor current when the pitch load moves negatively to an angle of θ; θ0 is the angle between the line segment OG between the center of mass G and the origin O and the positive direction of the X-axis; L is the distance from the center of mass of the pitch load to the origin.
6. The method for identifying the centroid position of the pitch load of a radar servo system according to claim 1, characterized in that: The functional relationship between the pitch load position, load mass, motor current, current-torque coefficient and load center of mass position parameters is: Where K I is the current-torque coefficient, m is the load mass, and g is the gravitational acceleration constant; I + (θ) is the motor current when the pitch load moves forward to position θ; I - (θ) is the motor current when the pitch load moves negatively to position θ; θ0 is the angle between the line segment OG between the center of mass G and the origin O and the positive direction of the X-axis; L is the distance from the center of mass of the pitch load to the origin.
