A method for estimating the roll angle measurement error of a laser beam-riding guided roll missile
By calculating the theoretical and practical acceleration angles of the laser beam-guided rolling missile, the problem of rolling angle measurement error caused by gyroscope calibration error is solved, and the accurate estimation of rolling angle error is achieved, and the missile hitting accuracy and control accuracy are improved. .
Patent Information
- Application Number
- CN202211371812.8
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-11-03
- Publication Date
- 2024-11-29
- Estimated Expiration
- Not applicable · inactive patent
AI Technical Summary
The laser beam guided rolling missile has a rolling angle measurement error due to the calibration error of the gyroscope on the gravity direction, which causes a deviation between the theoretical control force direction and the actual control force direction, affecting the missile's hit accuracy.
By calculating the angle between the theoretical acceleration and the actual acceleration, and using the conversion of the standard coordinate system and the dynamic coordinate system to determine the measurement error of the roll angle, a method for estimating the roll angle measurement error of the laser beam guided roll missile, including theoretical Acceleration calculation, actual acceleration measurement and roll angle measurement error solution module.
Accurate estimation of roll angle measurement errors is achieved, the calculation process is simplified, the missile hit accuracy is improved, the missile is avoided control coupling between pitch and yaw channels, and the helical line and off-target risks are reduced.
Smart Images

Figure CN116202379B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of missile guidance and control, and in particular to a method for estimating roll angle measurement errors. Background Art
[0002] Laser beam-riding guided missiles generate guidance commands based on the deviation from the position line of the laser beam center. Laser beam-riding guided rolling missiles use gyroscopes to sense the missile's spatial attitude. However, errors in the gyroscope's calibration of the direction of gravity lead to errors in the measured roll angle. Errors in roll angle measurement can cause a deviation between the theoretical and actual control force directions, leading to coupling in the missile's pitch and yaw control, a spiral trajectory, and even misses. Estimating roll angle measurement errors is crucial for improving the accuracy of laser beam-riding guided rolling missiles.
[0003] Currently, there is no effective method to estimate the roll angle measurement error of laser beam-riding guided rolling missiles. Summary of the Invention
[0004] The present disclosure provides a method for estimating the roll angle measurement error of a laser beam-riding guided rolling missile, which can accurately estimate the missile roll angle measurement error for use in correction and compensation of the control system.
[0005] A method for estimating roll angle measurement error of a laser beam-riding guided rolling missile comprises the following steps:
[0006] S1, calculates the theoretical acceleration generated by the missile control force under the ideal condition of no error in the roll angle;
[0007] S2, the onboard laser receiver processes the received laser signal, continuously obtains the distance deviation between the missile and the target, and calculates the actual acceleration generated by the missile control force;
[0008] S3, calculating the angle between two vectors, the theoretical acceleration generated by the control force and the actual acceleration generated by the control force, to determine a measurement error of the roll angle.
[0009] Furthermore, the step S1 specifically includes:
[0010] With the missile's center of mass as the origin, establish the first coordinate system, namely the standard coordinate system Ox1y1z1, whose x1 and y1 axes are located in the vertical plane of the laser beam axis, the x1 axis points to the horizontal direction, the y1 axis points to the opposite direction of the component of gravity in the plane, and the z1 direction satisfies the right-hand rule;
[0011] With the missile's center of mass as the origin, establish the second coordinate system, namely the moving coordinate system Ox2y2, whose x2 and y2 axes are also located in the vertical plane of the laser beam axis, and the y2 axis points to the opposite direction of the gravity direction calibrated by the missile's inertial measurement device in this plane;
[0012] In the ideal case of roll angle measurement error δ = 0, the acceleration vector a generated by the missile control force is ideal The x1 and y1 axis components in the standard coordinate system are:
[0013]
[0014] in,(·) i Represents the projection component of the vector in the i-th coordinate system; It is the component of the force calculated by the missile controller on the x2 and y2 axes of the second coordinate system; m is the mass of the missile.
[0015] Furthermore, the step S2 specifically includes:
[0016] With the missile's center of mass as the origin, establish the third coordinate system, namely the missile-target line coordinate system Ox3y3;
[0017] According to the distance deviation Δx and Δy between the projectile and the target, the angle θ between the projectile-target line coordinate system Ox3y3 and the standard coordinate system Ox1y1 is obtained as follows:
[0018]
[0019] Decompose the missile acceleration along the missile-target line and perpendicular to the missile-target line:
[0020]
[0021] in, is the tangential acceleration, is the normal acceleration, r is the distance between the projectile and the target,
[0022] The actual acceleration vector a generated by the missile control force is real The x1 and y1 axis components in the standard coordinate system are:
[0023]
[0024] Where g is the component of gravitational acceleration in the plane perpendicular to the laser beam axis.
[0025] Furthermore, the step S3 specifically includes:
[0026] The measurement error of the roll angle is:
[0027]
[0028] Where sign represents the sign of the error angle, which can be determined by the following formula:
[0029] Let vector
[0030]
[0031] but
[0032]
[0033] in(·) i (j) represents the jth component of the projection of the vector in the i coordinate system.
[0034] The present disclosure also provides a device for estimating roll angle measurement errors of a laser beam-riding guided rolling missile using the above method, comprising:
[0035] Theoretical acceleration calculation module, used to calculate the theoretical acceleration generated by the missile control force under the ideal condition of no roll angle error;
[0036] The actual acceleration measurement and calculation module is used to continuously obtain the distance deviation between the missile and the target and calculate the actual acceleration generated by the missile control force;
[0037] The roll angle measurement error calculation module is used to calculate the angle between the two vectors of the theoretical acceleration and the actual acceleration to determine the measurement error of the roll angle.
[0038] The method provided by the present disclosure obtains the roll angle measurement error by calculating the difference between the actual acceleration generated by the control force and the theoretical acceleration. Compared with the prior art, the present disclosure has the following advantages: (1) the roll angle measurement error can be accurately estimated by only knowing the linear deviation and the control force generated by the missile in the moving coordinate system; (2) although the formula derived by the present disclosure is based on a stationary target, actual simulation results show that for a target with an initial velocity and acceleration, when the target's acceleration is much smaller than the missile's acceleration, the method provided by the present disclosure can still accurately estimate the roll angle measurement error; (3) the method is simple and has high computational efficiency. BRIEF DESCRIPTION OF THE DRAWINGS
[0039] The above and other objects, features and advantages of the present disclosure will become more apparent through a more detailed description of exemplary embodiments of the present disclosure in conjunction with the accompanying drawings, wherein like reference numerals generally represent like components throughout the exemplary embodiments of the present disclosure.
[0040] Figure 1 Showing a flow chart of an exemplary embodiment according to the present disclosure;
[0041] Figure 2Schematic diagram of the established coordinate system;
[0042] Figure 3 This is a schematic diagram of missile acceleration decomposition. The vector directions in the figure represent the positive directions of tangential and normal accelerations. DETAILED DESCRIPTION
[0043] The preferred embodiments of the present disclosure will be described in more detail below with reference to the accompanying drawings. Although preferred embodiments of the present disclosure are shown in the accompanying drawings, it should be understood that the present disclosure can be implemented in various forms and should not be limited by the embodiments set forth herein. Rather, these embodiments are provided to make the present disclosure more thorough and complete, and to fully convey the scope of the present disclosure to those skilled in the art.
[0044] The present disclosure provides a method for estimating the roll angle measurement error of a laser beam-riding guided rolling missile. The method uses the information that can be obtained by the laser beam-riding missile and derives the roll angle measurement error according to the difference between the theoretical acceleration and the actual acceleration. Figure 1 shown.
[0045] An exemplary embodiment includes the following steps:
[0046] Step 1: Examine the missile's motion perpendicular to the laser beam plane, treating the missile M as a point mass and T as the target. Define the standard coordinate system Ox1y1, the moving coordinate system Ox2y2, and the missile-target line coordinate system Ox3y3, after calibrating the gravity direction using the gyroscope. The angle between the moving coordinate system and the standard coordinate system is δ, which is positive when Ox1 rotates counterclockwise to Ox2. Its value is equal to the missile's roll angle measurement error. The angle between the missile-target line coordinate system Ox3y3 and the standard coordinate system Ox1y1 is θ, which is positive when Ox1 rotates counterclockwise to Ox3. The missile-target distance is r. The control force generated by the missile includes the control force generated by the linear deviation through the correction network and gravity compensation.
[0047] The transformation matrix from the standard coordinate system to the moving coordinate system is:
[0048]
[0049] The transformation matrix from the standard coordinate system to the missile-target line coordinate system is:
[0050]
[0051] Position line deviation
[0052]
[0053] in
[0054]
[0055] Step 2: The missile kinematics and dynamics are described in standard coordinates as:
[0056]
[0057] Where m is the mass of the missile, F x and F y It is the projection of the control force generated by the missile in the standard coordinate system, and its calculation method is as follows:
[0058]
[0059] in is the force solved by the missile controller.
[0060] Step 3:
[0061] Decompose the missile acceleration in the direction perpendicular to the missile-target line and in the direction along the missile-target line. According to the acceleration synthesis theorem
[0062] a a =a r +a e +a C (7)
[0063] Among them, a a is the absolute acceleration of the missile, a r is the relative acceleration, a e is the drag acceleration, a C is the Coriolis acceleration. Equation (7) can be further written as
[0064]
[0065] Where ω is the angular velocity of the line connecting the projectile and the target. From formula (8), we can get:
[0066]
[0067] In the ideal case of error angle δ = 0, the components of the acceleration vector generated by the missile control force in the standard coordinate system can be expressed as:
[0068]
[0069] in(·) i Represents the projection component of the vector in coordinate system i.
[0070] The components of the actual acceleration vector generated by the missile control force in the standard coordinate system can be expressed as:
[0071]
[0072] When the laser beam is not horizontal, g is the component of the gravitational acceleration in the plane perpendicular to the laser beam being studied. In this case, it is necessary to know the angle information between the laser beam and the horizontal plane.
[0073] Step 4:
[0074] Calculation error angle
[0075]
[0076] Where sign represents the sign of the error angle, which can be determined by the following formula:
[0077] Let vector
[0078]
[0079] but
[0080]
[0081] in(·) i (j) represents the jth component of the projection of the vector in the i coordinate system.
[0082] To apply the method described in this disclosure, it is necessary to utilize the characteristics of laser beam-riding missiles to obtain the linear deviation of the distance between the missile and the center of the laser beam. If the laser beam is not horizontal, additional angular information of the angle between the laser beam and the horizontal plane is required, but this information is difficult to obtain with current technical means. To address this problem, the following method can be adopted (i.e., without obtaining laser beam angle information): For striking ground targets, the laser beam is approximately horizontal, and the method described in this disclosure is still applicable. Since the missile roll angle error can be solved very quickly, the missile can be allowed to fly for a short period of time with the laser beam horizontal, and then aim at the target after the error angle is solved, that is, the laser beam angle is changed.
[0083] The above technical solutions are only exemplary embodiments of the present invention. For those skilled in the art, it is easy to make various types of improvements or modifications based on the application methods and principles disclosed in the present invention, and are not limited to the methods described in the above specific embodiments of the present invention. Therefore, the methods described above are only preferred and do not have a restrictive meaning.
Claims
1. A method for estimating the roll angle measurement error of a laser beam-riding guided rolling missile, comprising the following steps: S1, calculates the theoretical acceleration generated by the missile control force under the ideal condition of no roll angle error; S2, the laser receiving device on the missile processes the received laser signal, continuously obtains the distance deviation between the missile and the target, and calculates the actual acceleration generated by the missile control force; S3, calculating the angle between two vectors, a theoretical acceleration generated by the control force and an actual acceleration generated by the control force, to determine a measurement error of the roll angle; The step S1 specifically includes: With the missile's center of mass as the origin, establish the first coordinate system, namely the standard coordinate system Ox1y1z1, whose x1 and y1 axes are located in the vertical plane of the laser beam axis, the x1 axis points to the horizontal direction, the y1 axis points to the opposite direction of the gravity component in the plane, and the z1 direction satisfies the right-hand rule; With the missile's center of mass as the origin, establish the second coordinate system, namely the moving coordinate system Ox2y2, whose x2 and y2 axes are also located in the vertical plane of the laser beam axis, and the y2 axis points to the opposite direction of the gravity direction calibrated by the missile's inertial measurement device in the plane component; In the ideal case where the roll angle measurement error δ = 0, the acceleration vector a generated by the missile control force ideal The x1 and y1 axis components in the standard coordinate system are: in,(·) i Represents the projection component of the vector in the i-th coordinate system; is the force calculated by the missile controller on the x2 and y2 axes of the second coordinate system; m is the mass of the missile; The step S2 specifically includes: With the missile's mass center as the origin, establish the third coordinate system, namely the missile-target line coordinate system Ox3y3; According to the distance deviations Δx and Δy between the projectile and the target, the angle θ between the projectile-target line coordinate system Ox3y3 and the standard coordinate system Ox1y1 is obtained as follows: Decompose the missile acceleration along the missile-target line and perpendicular to the missile-target line: in, is the tangential acceleration, is the normal acceleration, r is the distance between the projectile and the target, The actual acceleration vector a generated by the missile control force is real The x1 and y1 axis components in the standard coordinate system are: Where g is the component of gravitational acceleration in the plane perpendicular to the laser beam axis; The step S3 specifically includes: The measurement error of the roll angle is: Among them, sign represents the sign of the error angle, which can be determined by the following formula: Let vector but in(·) i (j) represents the jth component of the projection of the vector in the i coordinate system.
Citation Information
Patent Citations
System and method for model-based inertial navigation of rotating projectile
CN115014335A
