Three-axis inertial sensor calibration method based on single-degree-of-freedom servo motor
By using a single-degree of freedom servo motor to rotate integers on an inertial sensor, combining the earth's influence factor for integration and smoothing, the problem of inefficiency of traditional calibration methods is solved, and fast calibration and efficient zero-bias error compensation in an external field environment are achieved .
Patent Information
- Application Number
- CN202411106511.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-12
- Publication Date
- 2024-11-26
AI Technical Summary
The traditional inertial sensor calibration method needs to be performed on the turntable, which limits the calibration scenario, especially for the UAV platform of MEMS devices, which is inefficient and cannot fully compensate for the zero deviation error of the inertial sensor, especially in the external field environment.
Using a three-axis inertial sensor calibration method based on a single-degree of freedom servo motor, the servo motor rotates an integer number of turns, uses the earth influence factor to establish an initial output model, perform integration and smoothing processing, calculate and compensate for the zero deviation error of the inertial sensor, and eliminate the earth influence The effect of factors on zero bias error.
It realizes rapid calibration of inertial sensors in an external field environment, improves calibration efficiency, reduces time cost, and efficiently eliminates the impact of earth-influence factors on the zero deviation error of inertial sensors.
Smart Images

Figure CN119022963A_ABST
Abstract
Description
Technical Field
[0001] The invention belongs to the technical field of inertial device calibration, and in particular relates to a three-axis inertial sensor calibration method based on a single-degree-of-freedom servo motor. Background Art
[0002] Due to its complete autonomy, independence from external information, and immunity to external interference, inertial navigation systems are widely used in aerospace, aviation, navigation, missiles and other fields, and play an important role in national defense and the national economy. In recent years, my country's space technology has developed vigorously, and inertial technology has also made great progress. The inertial measurement unit is the core component of the inertial navigation system. The inertial measurement unit contains gyroscopes and accelerometers. Gyroscopes, accelerometers and inertial measurement units are all inertial sensors. The performance of inertial sensors is the main factor that determines the performance of inertial navigation systems. However, there are many different types of errors in inertial sensors, which will interfere with their output data as the system runs for a long time. The deterministic errors of inertial sensors mainly include zero bias error, scale factor error and non-orthogonality error.
[0003] At present, the traditional calibration method is the analytical method in discrete-level calibration, that is, to build a gyroscope error model, then fix the gyroscope on a turntable and rotate the X, Y, and Z axes of the gyroscope forward and reverse respectively, and substitute the measured values back into the model to find the error term parameters, so it is also called the angular rate rotation method. This method can effectively eliminate the zero bias error, scale factor error, and non-orthogonal error generated during the gyroscope measurement process. For example, the patent with publication number CN117589203A proposes a gyroscope calibration method, and the patent with publication number CN114088118A discloses a forward and reverse method MEMS gyroscope calibration compensation method.
[0004] Most inertial sensors have been calibrated before leaving the factory, and fixed deviations have been compensated. Although the deterministic error of the inertial sensor has been compensated before leaving the factory, the zero bias repeatability is generally poor, and the zero bias value is different each time the device is turned on. Therefore, the calibration before leaving the factory cannot completely compensate for the zero bias error of the inertial sensor, and secondary calibration is required. The traditional calibration method needs to be fixed on a turntable, which limits the calibration scenario and is not conducive to field calibration during the use of the device. In addition, for drone platforms equipped with MEMS devices, they need to be disassembled each time, which leads to low calibration efficiency and introduces a lot of time cost. Summary of the invention
[0005] In view of the shortcomings of the prior art, the purpose of the present invention is to provide a three-axis inertial sensor calibration method based on a single-degree-of-freedom servo motor, which can eliminate the influence of the earth's influence factor on the zero bias error of the inertial sensor and realize rapid calibration of the inertial sensor in an outdoor environment.
[0006] To achieve the above object, the present invention adopts the following technical solution: a three-axis inertial sensor calibration method based on a single-degree-of-freedom servo motor, comprising the following steps: S1. Fix the inertial sensor to be calibrated again after leaving the factory on the shaft of the servo motor, so that the Z axis of the inertial sensor coincides with the shaft of the servo motor, and rotate the servo motor for an integer number of revolutions at a speed not higher than 30° / s; S2. Based on the earth influence factor of the inertial sensor, an initial output model of the inertial sensor under the condition of servo motor rotation is established, wherein the initial output model includes initial output models of X, Y, and Z axes; S3, integrating and smoothing the initial output models of the X and Y axes of the inertial sensor to obtain the zero bias errors of the X and Y axes of the inertial sensor; S4, compensating the zero bias errors of the X and Y axes of the inertial sensor to obtain an output model after zero bias compensation of the X and Y axes; S5, smoothing the output model after X-axis zero bias compensation or the output model after Y-axis zero bias compensation to obtain the smoothed output model after X-axis or Y-axis zero bias compensation; integrating the absolute value of the smoothed output model after X-axis or Y-axis zero bias compensation within an integer multiple period to obtain the component parameters of the earth influence factor on the plane formed by the X and Y axes; according to the component parameters of the earth influence factor on the plane formed by the X and Y axes, calculating the component parameters of the earth influence factor on the Z axis; S6, averaging and smoothing the Z-axis initial output model of the inertial sensor to obtain a Z-axis averaged smoothed output model; substituting the component parameters of the earth influence factor on the Z-axis into the Z-axis averaged smoothed output model to obtain the zero bias error of the Z-axis of the inertial sensor; S7. Compensate for the zero bias error of the Z-axis of the inertial sensor, that is, complete the secondary calibration of the inertial sensor.
[0007] Preferably, in step S1, the inertial sensor is a gyroscope, an accelerometer, or an inertial measurement unit including a gyroscope and an accelerometer.
[0008] Preferably, in step S5, the sum of the squares of the component parameters of the earth influence factor on the plane composed of the X and Y axes and the component parameters of the earth influence factor on the Z axis is equal to 1, and the component parameters of the earth influence factor on the Z axis are greater than 0 and less than 1.
[0009] Compared with the prior art, the present invention has the following beneficial effects: based on the current situation of poor zero bias repeatability of inertial sensors, the present invention utilizes the characteristic that the integral of trigonometric functions within integer multiple periods is zero, calculates the component parameters of the earth influence factor on the plane composed of the X and Y axes and the component parameters of the earth influence factor on the Z axis, and eliminates the influence of the earth influence factor on the zero bias error of the inertial sensor by compensating the zero bias error of the inertial sensor on the X, Y and Z axes, thereby realizing rapid calibration of the inertial sensor in an outdoor environment, with high calibration efficiency and low time cost. BRIEF DESCRIPTION OF THE DRAWINGS
[0010] In order to more clearly illustrate the technical solutions in the present invention or the prior art, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. Obviously, for ordinary technicians in this field, other drawings can be obtained based on the drawings in the following description without paying any creative work.
[0011] Figure 1 The present invention is a flowchart of a three-axis inertial sensor calibration method based on a single-degree-of-freedom servo motor.
[0012] Figure 2 This is a workflow diagram of a three-axis inertial measurement unit calibration method based on a single-degree-of-freedom servo motor according to Example 1 of the present invention.
[0013] Figure 3 This is a workflow diagram of a three-axis gyroscope calibration method based on a single-degree-of-freedom servo motor according to Example 2 of the present invention.
[0014] Figure 4 This is a workflow diagram of a three-axis accelerometer calibration method based on a single-degree-of-freedom servo motor according to Example 3 of the present invention. DETAILED DESCRIPTION
[0015] In order to make the purpose, technical solutions and advantages of the present invention clearer, the technical solutions in the present invention will be clearly and completely described below in conjunction with the drawings in the present invention. Obviously, the described embodiments are part of the embodiments of the present invention, rather than all of the embodiments. Based on the embodiments in the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention. In order to make the above-mentioned features and advantages of the present invention more obvious and easy to understand, the following embodiments are specifically cited and described in detail with the drawings.
[0016] like Figure 1 As shown, the present invention provides a three-axis inertial sensor calibration method based on a single-degree-of-freedom servo motor, comprising the following steps: S1. Fix the inertial sensor to be calibrated again after leaving the factory on the shaft of the servo motor, so that the Z axis of the inertial sensor coincides with the shaft of the servo motor, and rotate the servo motor for an integer number of turns at a speed not higher than 30° / s, for example, 5 turns at a speed of 5° / s (i.e. 6 minutes); S2. Based on the earth influence factor of the inertial sensor, an initial output model of the inertial sensor under the condition of servo motor rotation is established, wherein the initial output model includes initial output models of X, Y, and Z axes; S3, integrating and smoothing the initial output models of the X and Y axes of the inertial sensor to obtain the zero bias errors of the X and Y axes of the inertial sensor; S4, compensating the zero bias errors of the X and Y axes of the inertial sensor to obtain an output model after zero bias compensation of the X and Y axes; S5, smoothing the output model after X-axis zero bias compensation or the output model after Y-axis zero bias compensation to obtain the smoothed output model after X-axis or Y-axis zero bias compensation; integrating the absolute value of the smoothed output model after X-axis or Y-axis zero bias compensation within an integer multiple period to obtain the component parameters of the earth influence factor on the plane formed by the X and Y axes; according to the component parameters of the earth influence factor on the plane formed by the X and Y axes, calculating the component parameters of the earth influence factor on the Z axis; S6, averaging and smoothing the Z-axis initial output model of the inertial sensor to obtain a Z-axis averaged smoothed output model; substituting the component parameters of the earth influence factor on the Z-axis into the Z-axis averaged smoothed output model to obtain the zero bias error of the Z-axis of the inertial sensor; S7. Compensate for the zero bias error of the Z-axis of the inertial sensor, that is, complete the secondary calibration of the inertial sensor.
[0017] In the present invention, the inertial sensor may be a gyroscope, an accelerometer, an inertial measurement unit including a gyroscope and an accelerometer, etc.
[0018] The earth influence factor of the gyroscope is the earth's rotation angular velocity, and the earth influence factor of the accelerometer is the earth's gravity.
[0019] Among them, the initial output models of the gyroscope and accelerometer are respectively: Gyro output = carrier angular velocity + ground speed component + measurement error + noise; Accelerometer output = carrier acceleration + gravity projection + lever arm + measurement error + noise.
[0020] In the present invention, in step S3, the integration process utilizes the characteristic that the integral of a trigonometric function within an integer multiple period is zero, thereby eliminating the influence of the earth's influence factor on the inertial sensor.
[0021] In the present invention, in step S5, the sum of the squares of the component parameters of the earth influence factor on the plane composed of the X and Y axes and the component parameters of the earth influence factor on the Z axis is equal to 1, and the component parameters of the earth influence factor on the Z axis are greater than 0 and less than 1.
[0022] The following takes a gyroscope, an accelerometer, and an inertial measurement unit including the gyroscope and the accelerometer as specific embodiments.
[0023] Example 1: Figure 2 As shown, a three-axis inertial measurement unit calibration method based on a single-degree-of-freedom servo motor includes the following steps: S1. Fix the inertial measurement unit to be calibrated again after leaving the factory on the shaft of the servo motor, so that the Z axes of the gyroscope and accelerometer in the inertial measurement unit coincide with the shaft of the servo motor, and rotate the servo motor for an integer number of circles at a speed not higher than 30° / s; S2. Based on the earth's rotation angular velocity and the earth's gravity, initial output models of the gyroscope and the accelerometer under the condition of servo motor rotation are established, and the initial output models include X, Y, and Z axis initial output models; S3, integrating and smoothing the initial output models of the X and Y axes of the gyroscope and the accelerometer, respectively, to obtain the zero bias errors of the X and Y axes of the gyroscope and the accelerometer; S4, respectively compensating the zero bias errors of the gyroscope and the accelerometer X and Y axes to obtain the output model after zero bias compensation of the gyroscope and the accelerometer X and Y axes; S5, respectively smoothing the output model of the gyroscope and accelerometer after X-axis zero bias compensation or the output model of the gyroscope and accelerometer after Y-axis zero bias compensation to obtain the smoothed output model of the gyroscope and accelerometer; integrating the absolute values of the smoothed output models of the gyroscope and accelerometer within an integer multiple period to obtain the component parameters of the earth's rotation angular velocity and the earth's gravity on the plane formed by the X and Y axes; respectively calculating the component parameters of the earth's rotation angular velocity and the earth's gravity on the Z axis according to the component parameters of the earth's rotation angular velocity and the earth's gravity on the plane formed by the X and Y axes; S6, respectively averaging and smoothing the Z-axis initial output models of the gyroscope and the accelerometer to obtain the Z-axis averaged smoothed output models of the gyroscope and the accelerometer; respectively substituting the component parameters of the earth's rotation angular velocity and the earth's gravity on the Z-axis into the Z-axis averaged smoothed output models of the gyroscope and the accelerometer to obtain the Z-axis zero bias errors of the gyroscope and the accelerometer; S7. Compensate the zero bias errors of the gyroscope and accelerometer Z-axis respectively, that is, complete the secondary calibration of the inertial measurement unit.
[0024] In this embodiment, step S2 specifically includes: S21. Based on the earth's rotation angular velocity, establish the initial output model of the gyroscope under the condition of servo motor rotation. The specific process is as follows: Taking into account the effect of the earth's rotation angular velocity on the gyroscope output, the initial output model of the gyroscope is: Gyro output = carrier angular velocity + ground speed component + measurement error + noise; Among them, the carrier angular velocity is the true angular velocity of the gyroscope, the measurement error is the zero bias error of the gyroscope, and the noise is the angle random walk of the gyroscope. Since the gyroscope has been calibrated before leaving the factory, the scale factor error and non-orthogonality error can be ignored during the secondary calibration, and only the new zero bias generated by the poor zero bias repeatability is calibrated. Abstracting the ground speed component, we get: Among them, w ze is the component of the earth's rotation angular velocity on the gyroscope Z axis, w xoye is the component of the earth's rotation angular velocity on the plane formed by the gyroscope's X and Y axes, a is the component parameter of the earth's rotation angular velocity on the gyroscope's Z axis, b is the component parameter of the earth's rotation angular velocity on the plane formed by the gyroscope's X and Y axes, and w e is the angular velocity of the Earth's rotation; Therefore, the specific expression of the initial output model of the gyroscope is as follows: In the formula, are the output angular velocities of the gyroscope's X, Y, and Z axes, θ is the angle of rotation of the servo motor, and w x (t),w y (t),w z (t) are the true angular velocities of the gyroscope’s X, Y, and Z axes, respectively, and ε x ,ε y ,ε z are the zero bias errors of the gyroscope X, Y, and Z axes, δw x ,δw y ,δw z They are the random walk of the angles of the gyroscope X, Y, and Z axes respectively; S22. Based on the earth's gravity, establish the initial output model of the accelerometer under the condition of servo motor rotation. The specific process is as follows: Taking into account the influence of the earth's gravity on the accelerometer output, that is, the earth's gravity is the earth's influence factor of the accelerometer, the initial output model of the accelerometer is: Accelerometer output = carrier acceleration + gravity projection + lever arm + measurement error + noise; Among them, the carrier acceleration is the true acceleration of the accelerometer's X, Y, and Z axes, the measurement error is the zero bias error of the accelerometer's X, Y, and Z axes, and the noise is the angle random walk of the accelerometer's X, Y, and Z axes. Since the accelerometer has been calibrated before leaving the factory, the scale factor error and non-orthogonality error can be ignored during the secondary calibration, and only the new zero bias generated by poor zero bias repeatability is calibrated. Abstracting the gravity projection, we get: Among them, f z is the component of the earth's gravity on the Z axis of the accelerometer, f xoy is the component of the earth's gravity on the plane formed by the X and Y axes of the accelerometer, A is the component parameter of the earth's gravity on the Z axis of the accelerometer, B is the component parameter of the earth's gravity on the plane formed by the X and Y axes of the accelerometer, and g is the earth's gravity; Therefore, the specific expression of the initial output model of the accelerometer is as follows: In the formula, are the output angular velocities of the accelerometer's X, Y, and Z axes, θ is the angle of rotation of the servo motor, and f x (t),f y (t),f z (t) are the true accelerations of the accelerometer’s X, Y, and Z axes, respectively. are the zero bias errors of the accelerometer X, Y, and Z axes, δf x ,δf y ,δf z They are the random walk of the angles of the accelerometer X, Y, and Z axes, respectively.
[0025] In this embodiment, step S3 specifically includes: S31, integrating and smoothing the initial output models of the X and Y axes of the gyroscope to obtain the zero bias error of the X axis of the gyroscope and the zero bias error of the Y axis of the gyroscope. The specific process is as follows: The output data of the gyroscope is collected, and the expressions of the initial output models of the gyroscope X and Y axes are integrated respectively to obtain: Among them, k is the number of revolutions of the servo motor, and n is the number of samples collected for each revolution of the servo motor; Since the integral of the trigonometric function within an integer multiple period is 0, that is: therefore: And because when the gyroscope Z axis rotates around the servo motor, the true angular velocity on the X axis and Y axis is 0, that is: w x (t) = w y (t) = 0; Therefore, the integral expressions of the initial output models of the gyroscope X and Y axes are transformed into: At this time, the zero bias errors of the gyroscope X and Y axes are still buried in the noise. The zero bias errors of the gyroscope X and Y axes can be obtained by smoothing the integral expressions of the converted gyroscope X-axis initial output model and Y initial output model, that is: S32, integrating and smoothing the initial output models of the X and Y axes of the accelerometer to obtain the zero bias error of the X axis and the zero bias error of the Y axis of the accelerometer. The specific process is as follows: Collect the output data of the accelerometer, integrate the expressions of the initial output model of the accelerometer X and Y axes respectively, and get: Among them, k is the number of revolutions of the servo motor, and n is the number of samples collected for each revolution of the servo motor; Since the integral of the trigonometric function within an integer multiple period is 0, that is: therefore: Because when the accelerometer Z axis rotates around the servo motor, the true angular velocity on the X axis and Y axis is 0, that is: f x (t) = f y (t) = 0; Therefore, the integral expressions of the initial output models of the accelerometer X and Y axes are transformed into: Among them, (w z (t)) 2 r x and (w z (t)) 2 r y is the lever arm error term, rx is the lever arm length in the X-axis direction, and ry is the lever arm length in the Y-axis direction; Since the lever arm error term is small, it is ignored; for example, when the servo motor rotates around the Z axis at a speed of 5° / s, then: Can be ignored; Therefore, the integral expressions of the initial output models of the accelerometer X and Y axes are transformed into: At this time, the zero bias errors of the accelerometer X and Y axes are still buried in the noise. The zero bias errors of the accelerometer X and Y axes can be obtained by smoothing the integral expressions of the converted accelerometer X and Y initial output models, that is:
[0026] In this embodiment, step S5 specifically includes: S51, smoothing the output model after X-axis bias compensation or the output model after Y-axis bias compensation to obtain a smoothed output model; integrating the absolute value of the smoothed output model within an integer multiple period to obtain component parameters of the earth's rotation angular velocity on the plane formed by the X and Y axes; calculating the component parameters of the earth's rotation angular velocity on the Z axis according to the component parameters of the earth's rotation angular velocity on the plane formed by the X and Y axes; substituting the component parameters of the earth's rotation angular velocity on the Z axis into the smoothed output model after Z-axis averaging to obtain the zero bias error of the gyroscope Z axis; the specific process is as follows: The output model of the gyroscope after X-axis zero bias compensation is smoothed to obtain the smoothed output model of the gyroscope after X-axis zero bias compensation, that is: The absolute value of the smoothed output model after the gyroscope X-axis zero bias compensation is integrated within an integer multiple period (for example, one period is sufficient) to obtain: Right now: Then the component parameter b of the earth's rotation angular velocity on the plane formed by the X and Y axes is: Therefore, the component parameter a of the Earth's rotation angular velocity on the Z axis is: Substituting the component parameter a of the earth's rotation angular velocity on the Z axis into the average smoothed output model expression of the gyroscope Z axis, the zero bias of the gyroscope Z axis can be obtained, that is: Alternatively, the output model of the gyroscope Y-axis zero bias compensation is smoothed to obtain the smoothed output model of the gyroscope Y-axis zero bias compensation, that is: The absolute value of the smoothed output model after gyroscope Y-axis zero bias compensation is integrated within an integer multiple period to obtain: Right now: Then the component parameter b of the earth's rotation angular velocity on the plane formed by the X and Y axes is: Therefore, the component parameter a of the Earth's rotation angular velocity on the Z axis is: S52, smoothing the output model after X-axis zero bias compensation or the output model after Y-axis zero bias compensation to obtain a smoothed output model; integrating the absolute value of the smoothed output model within an integer multiple period to obtain the component parameters of the earth's gravity on the plane formed by the X and Y axes; calculating the component parameters of the earth's gravity on the Z axis according to the component parameters of the earth's gravity on the plane formed by the X and Y axes; substituting the component parameters of the earth's gravity on the Z axis into the smoothed output model after Z-axis averaging to obtain the zero bias error of the accelerometer Z axis; the specific process is as follows: The output model of the accelerometer after X-axis zero bias compensation is smoothed to obtain the smoothed output model of the accelerometer after X-axis zero bias compensation, that is: The absolute value of the smoothed output model of the accelerometer after X-axis zero bias compensation is integrated within an integer multiple period (for example, one period is sufficient) to obtain: Right now: Then the component parameter B of the earth's gravity on the plane formed by the X and Y axes is: Therefore, the component parameter A of the earth's gravity on the Z axis is: Substituting the component parameter A of the earth's gravity on the Z axis into the initial output model expression of the accelerometer Z axis, the zero bias error of the accelerometer Z axis can be obtained, that is: Alternatively, the output model of the accelerometer after Y-axis zero bias compensation is smoothed to obtain the smoothed output model of the accelerometer after Y-axis zero bias compensation, that is: The absolute value of the smoothed output model of the accelerometer Y-axis zero bias compensation is integrated within an integer multiple period to obtain: Right now: Then the component parameter B of the earth's gravity on the plane formed by the X and Y axes is: Therefore, the component parameter A of the earth's gravity on the Z axis is:
[0027] In this embodiment, step S6 specifically includes: S61, averaging and smoothing the initial output model of the Z axis of the gyroscope to obtain the averaged smoothed output model of the Z axis; substituting the component parameters of the earth's rotation angular velocity on the Z axis into the averaged smoothed output model of the Z axis to obtain the zero bias error of the Z axis of the gyroscope; the specific process is: The expression of the initial output model of the gyroscope Z axis is averaged to obtain the average output model of the gyroscope Z axis, that is: Among them, k is the number of revolutions of the servo motor, and n is the number of samples collected for each revolution of the servo motor; The expression of the gyroscope Z-axis average output model is smoothed to obtain the gyroscope Z-axis average smooth output model, that is: Substituting the component parameter a of the earth's rotation angular velocity on the Z axis into the average smoothed output model expression of the gyroscope Z axis, the zero bias error of the gyroscope Z axis can be obtained, that is: or S62, averaging and smoothing the initial output model of the Z axis of the accelerometer to obtain the averaged smoothed output model of the Z axis; substituting the component parameter of the earth's gravity on the Z axis into the averaged smoothed output model of the Z axis to obtain the zero bias error of the Z axis of the accelerometer; the specific process is: The expression of the initial output model of the accelerometer Z axis is averaged to obtain the average output model of the accelerometer Z axis, that is: Among them, k is the number of revolutions of the servo motor, and n is the number of samples collected for each revolution of the servo motor; Because when the accelerometer Z axis rotates around the servo motor, the true angular velocity on the Z axis is 0, that is: f z (t) = 0; Therefore, the expression of the accelerometer Z-axis average output model is transformed into: The transformed expression of the average output model of the accelerometer Z axis is smoothed to obtain the average smooth output model of the accelerometer Z axis, that is: Substituting the component parameter A of the earth's gravity on the Z axis into the average smoothed output model expression of the accelerometer Z axis, the zero bias error of the accelerometer Z axis can be obtained, that is: or
[0028] Example 2: Figure 3 As shown, a three-axis gyroscope calibration method based on a single-degree-of-freedom servo motor is different from Example 1 in that the inertial measurement unit is replaced by a gyroscope, that is, only the gyroscope is calibrated twice, and the rest of the contents are basically the same, specifically including the following steps: S1. Fix the gyroscope to be calibrated again after leaving the factory on the shaft of the servo motor, so that the Z axis of the gyroscope coincides with the shaft of the servo motor, and rotate the servo motor for an integer number of circles at a speed not higher than 30° / s; S2. Based on the earth influence factor of the gyroscope, an initial output model of the gyroscope under the condition of servo motor rotation is established, wherein the initial output model includes initial output models of X, Y, and Z axes; S3, integrating and smoothing the initial output model of the X and Y axes of the gyroscope to obtain the zero bias errors of the X and Y axes of the gyroscope; S4, compensating the zero bias errors of the X and Y axes of the gyroscope to obtain the output model after zero bias compensation of the X and Y axes; S5, smoothing the output model after X-axis zero bias compensation or the output model after Y-axis zero bias compensation to obtain the smoothed output model after X-axis or Y-axis zero bias compensation; integrating the absolute value of the smoothed output model after X-axis or Y-axis zero bias compensation within one cycle to obtain the component parameters of the earth influence factor on the plane composed of the X and Y axes; calculating the component parameters of the earth influence factor on the Z axis according to the component parameters of the earth influence factor on the plane composed of the X and Y axes; S6, averaging and smoothing the initial output model of the Z axis of the gyroscope to obtain a Z axis averaged smoothed output model; substituting the component parameters of the earth influence factor on the Z axis into the Z axis averaged smoothed output model to obtain the zero bias error of the Z axis of the gyroscope; S7. Compensate for the zero bias error of the Z-axis of the gyroscope, thereby completing the secondary calibration of the gyroscope.
[0029] Example 3: Figure 4As shown, a three-axis accelerometer calibration method based on a single-degree-of-freedom servo motor is different from Example 1 in that the inertial measurement unit is replaced by an accelerometer, that is, only the accelerometer is calibrated twice, and the rest of the contents are basically the same, specifically including the following steps: S1. Fix the accelerometer to be calibrated again after leaving the factory on the shaft of the servo motor, so that the Z axis of the accelerometer coincides with the shaft of the servo motor, and rotate the servo motor for an integer number of circles at a speed not higher than 30° / s; S2. Based on the earth influence factor of the accelerometer, an initial output model of the accelerometer under the condition of servo motor rotation is established, wherein the initial output model includes initial output models of X, Y, and Z axes; S3, integrating and smoothing the initial output models of the X and Y axes of the accelerometer to obtain the zero bias errors of the X and Y axes of the accelerometer; S4, compensating the zero bias errors of the X and Y axes of the accelerometer to obtain an output model after zero bias compensation of the X and Y axes; S5, smoothing the output model after X-axis zero bias compensation or the output model after Y-axis zero bias compensation to obtain the smoothed output model after X-axis or Y-axis zero bias compensation; integrating the absolute value of the smoothed output model after X-axis or Y-axis zero bias compensation within one cycle to obtain the component parameters of the earth influence factor on the plane composed of the X and Y axes; calculating the component parameters of the earth influence factor on the Z axis according to the component parameters of the earth influence factor on the plane composed of the X and Y axes; S6, averaging and smoothing the initial output model of the Z axis of the accelerometer to obtain a Z axis averaged smoothed output model; substituting the component parameters of the earth influence factor on the Z axis into the Z axis averaged smoothed output model to obtain the zero bias error of the Z axis of the accelerometer; S7. Compensate for the zero bias error of the Z-axis of the accelerometer, thereby completing the secondary calibration of the accelerometer.
[0030] The present invention can mainly be based on the current situation that the zero bias repeatability of inertial sensors such as gyroscopes, accelerometers and inertial measurement units including gyroscopes and accelerometers is poor, and utilizes the characteristic that the integral of trigonometric functions within integer multiple periods is zero, calculates the component parameters of the earth influence factor on the plane composed of the X and Y axes and the component parameters of the earth influence factor on the Z axis, and eliminates the influence of the earth influence factor on the zero bias error of inertial sensors such as gyroscopes, accelerometers and inertial measurement units including gyroscopes and accelerometers by compensating the zero bias errors of the X, Y and Z axes of inertial sensors such as gyroscopes, accelerometers and inertial measurement units including gyroscopes and accelerometers, so as to realize the rapid calibration of inertial sensors such as gyroscopes, accelerometers and inertial measurement units including gyroscopes and accelerometers in an outdoor environment, with high calibration efficiency and low time cost.
[0031] Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present invention, rather than to limit it. Although the present invention has been described in detail with reference to the aforementioned embodiments, those skilled in the art should understand that they can still modify the technical solutions described in the aforementioned embodiments, or make equivalent replacements for some of the technical features therein. However, these modifications or replacements do not deviate the essence of the corresponding technical solutions from the spirit and scope of the technical solutions of the embodiments of the present invention.
Claims
1. A three-axis inertial sensor calibration method based on a single-degree-of-freedom servo motor, characterized in that: The following steps are involved: S1. Fix the inertial sensor to be calibrated again after leaving the factory on the shaft of the servo motor, so that the Z axis of the inertial sensor coincides with the shaft of the servo motor, and rotate the servo motor for an integer number of revolutions at a speed not higher than 30° / s; S2. Based on the earth influence factor of the inertial sensor, an initial output model of the inertial sensor under the condition of servo motor rotation is established, wherein the initial output model includes initial output models of X, Y, and Z axes; S3, integrating and smoothing the initial output models of the X and Y axes of the inertial sensor to obtain the zero bias errors of the X and Y axes of the inertial sensor; S4, compensating the zero bias errors of the X and Y axes of the inertial sensor to obtain an output model after zero bias compensation of the X and Y axes; S5, smoothing the output model after X-axis zero bias compensation or the output model after Y-axis zero bias compensation to obtain the smoothed output model after X-axis or Y-axis zero bias compensation; integrating the absolute value of the smoothed output model after X-axis or Y-axis zero bias compensation within an integer multiple period to obtain the component parameters of the earth influence factor on the plane formed by the X and Y axes; according to the component parameters of the earth influence factor on the plane formed by the X and Y axes, calculating the component parameters of the earth influence factor on the Z axis; S6, averaging and smoothing the Z-axis initial output model of the inertial sensor to obtain a Z-axis averaged smoothed output model; substituting the component parameters of the earth influence factor on the Z-axis into the Z-axis averaged smoothed output model to obtain the zero bias error of the Z-axis of the inertial sensor; S7. Compensate for the zero bias error of the Z-axis of the inertial sensor, that is, complete the secondary calibration of the inertial sensor.
2. The three-axis inertial sensor calibration method based on a single-degree-of-freedom servo motor according to claim 1 is characterized in that: In step S5, the sum of the squares of the component parameters of the earth influence factor on the plane composed of the X and Y axes and the component parameters of the earth influence factor on the Z axis is equal to 1, and the component parameters of the earth influence factor on the Z axis are greater than 0 and less than 1.
3. The three-axis inertial sensor calibration method based on a single-degree-of-freedom servo motor according to claim 2 is characterized in that: In step S1, the inertial sensor includes a gyroscope; step S2 specifically includes: S21. Based on the earth's rotation angular velocity, establish the initial output model of the gyroscope under the condition of servo motor rotation. The specific process is as follows: Taking into account the influence of the earth's rotation angular velocity on the gyroscope output, that is, the earth's rotation angular velocity is the earth's influence factor of the gyroscope, the initial output model of the gyroscope is: Gyro output = carrier angular velocity + ground speed component + measurement error + noise; Among them, the carrier angular velocity is the true angular velocity of the gyroscope, the measurement error is the zero bias error of the gyroscope, and the noise is the angular random walk of the gyroscope; Abstracting the ground speed component, we get: Among them, w ze is the component of the earth's rotation angular velocity on the gyroscope Z axis, w xoye is the component of the earth's rotation angular velocity on the plane formed by the gyroscope's X and Y axes, a is the component parameter of the earth's rotation angular velocity on the gyroscope's Z axis, b is the component parameter of the earth's rotation angular velocity on the plane formed by the gyroscope's X and Y axes, and w e is the angular velocity of the Earth's rotation; Therefore, the specific expression of the initial output model of the gyroscope is as follows: In the formula, are the output angular velocities of the gyroscope's X, Y, and Z axes, θ is the angle of rotation of the servo motor, and w x (t),w y (t),w z (t) are the true angular velocities of the gyroscope’s X, Y, and Z axes, respectively, and ε x ,ε y ,ε z are the zero bias errors of the gyroscope X, Y, and Z axes, δw x ,δw y ,δw z They are the random walk of the gyroscope's X, Y, and Z axes.
4. The three-axis inertial sensor calibration method based on a single-degree-of-freedom servo motor according to claim 3 is characterized in that: Step S3 specifically includes: S31, integrating and smoothing the initial output models of the X and Y axes of the gyroscope to obtain the zero bias error of the X axis of the gyroscope and the zero bias error of the Y axis of the gyroscope. The specific process is as follows: The expressions of the initial output models of the gyroscope X and Y axes are integrated respectively to obtain: Among them, k is the number of revolutions of the servo motor, and n is the number of samples collected for each revolution of the servo motor; Since the integral of the trigonometric function within an integer multiple period is 0, that is: therefore: And because when the gyroscope Z axis rotates around the servo motor, the true angular velocity on the X axis and Y axis is 0, that is: w x (t)=w y (t)=0; Therefore, the integral expressions of the initial output models of the gyroscope X and Y axes are transformed into: By smoothing the integral expressions of the transformed gyroscope X-axis initial output model and Y-axis initial output model, the zero bias error of the gyroscope X and Y axes can be obtained, that is:
5. The three-axis inertial sensor calibration method based on a single-degree-of-freedom servo motor according to claim 4 is characterized in that: Step S5 specifically includes: S51, smoothing the output model of the X-axis zero bias compensation or the output model of the Y-axis zero bias compensation of the gyroscope to obtain the smoothed output model of the X-axis or Y-axis zero bias compensation; integrating the absolute value of the smoothed output model of the X-axis or Y-axis zero bias compensation within an integer multiple period to obtain the component parameters of the earth's rotation angular velocity on the plane formed by the X and Y axes; calculating the component parameters of the earth's rotation angular velocity on the Z axis according to the component parameters of the earth's rotation angular velocity on the plane formed by the X and Y axes; the specific process is as follows: The output model of the gyroscope after X-axis zero bias compensation is smoothed to obtain the smoothed output model of the gyroscope after X-axis zero bias compensation, that is: The absolute value of the smoothed output model after the gyroscope X-axis zero bias compensation is integrated within an integer multiple period to obtain: Right now: Then the component parameter b of the earth's rotation angular velocity on the plane formed by the X and Y axes is: Therefore, the component parameter a of the Earth's rotation angular velocity on the Z axis is: Alternatively, the output model of the gyroscope Y-axis zero bias compensation is smoothed to obtain the smoothed output model of the gyroscope Y-axis zero bias compensation, that is: The absolute value of the smoothed output model after gyroscope Y-axis zero bias compensation is integrated within an integer multiple period to obtain: Right now: Then the component parameter b of the earth's rotation angular velocity on the plane formed by the X and Y axes is: Therefore, the component parameter a of the Earth's rotation angular velocity on the Z axis is:
6. The three-axis inertial sensor calibration method based on a single-degree-of-freedom servo motor according to claim 5 is characterized in that: Step S6 specifically includes: S61, averaging and smoothing the initial output model of the Z axis of the gyroscope to obtain the averaged smoothed output model of the Z axis; substituting the component parameters of the earth's rotation angular velocity on the Z axis into the averaged smoothed output model of the Z axis to obtain the zero bias error of the Z axis of the gyroscope; the specific process is: The expression of the initial output model of the gyroscope Z axis is averaged to obtain the average output model of the gyroscope Z axis, that is: Among them, k is the number of revolutions of the servo motor, and n is the number of samples collected for each revolution of the servo motor; The expression of the gyroscope Z-axis average output model is smoothed to obtain the gyroscope Z-axis average smooth output model, that is: Substituting the component parameter a of the earth's rotation angular velocity on the Z axis into the average smoothed output model expression of the gyroscope Z axis, the zero bias error of the gyroscope Z axis can be obtained, that is:
7. A three-axis inertial sensor calibration method based on a single-degree-of-freedom servo motor according to claim 2 or 3, characterized in that: In step S1, the inertial sensor includes an accelerometer; step S2 specifically includes: S22. Based on the earth's gravity, establish the initial output model of the accelerometer under the condition of servo motor rotation. The specific process is as follows: Taking into account the influence of the earth's gravity on the accelerometer output, that is, the earth's gravity is the earth's influence factor of the accelerometer, the initial output model of the accelerometer is: Accelerometer output = carrier acceleration + gravity projection + lever arm + measurement error + noise; Among them, the carrier acceleration is the true acceleration of the accelerometer X, Y, and Z axes, the measurement error is the zero bias error of the accelerometer X, Y, and Z axes, and the noise is the angle random walk of the accelerometer X, Y, and Z axes; Abstracting the gravity projection, we get: Among them, f z is the component of the earth's gravity on the Z axis of the accelerometer, f xoy is the component of the earth's gravity on the plane formed by the X and Y axes of the accelerometer, A is the component parameter of the earth's gravity on the Z axis of the accelerometer, B is the component parameter of the earth's gravity on the plane formed by the X and Y axes of the accelerometer, and g is the earth's gravity; Therefore, the specific expression of the initial output model of the accelerometer is as follows: In the formula, are the output angular velocities of the accelerometer's X, Y, and Z axes, θ is the angle of rotation of the servo motor, and f x (t),f y (t),f z (t) are the true accelerations of the accelerometer’s X, Y, and Z axes, respectively. are the zero bias errors of the accelerometer X, Y, and Z axes, δf x ,δf y ,δf z They are the random walk of the angles of the accelerometer X, Y, and Z axes, respectively.
8. The three-axis inertial sensor calibration method based on a single-degree-of-freedom servo motor according to claim 7, characterized in that: In step S3, the initial output model of the X and Y axes of the inertial sensor is integrated and smoothed to obtain the zero bias error of the X and Y axes of the inertial sensor, which specifically includes: S32, integrating and smoothing the initial output models of the X and Y axes of the accelerometer to obtain the zero bias error of the X axis and the zero bias error of the Y axis of the accelerometer. The specific process is as follows: The expressions of the initial output models of the accelerometer X and Y axes are integrated respectively to obtain: Among them, k is the number of revolutions of the servo motor, and n is the number of samples collected for each revolution of the servo motor; Since the integral of the trigonometric function within an integer multiple period is 0, that is: therefore: Because when the accelerometer Z axis rotates around the servo motor, the true angular velocity on the X axis and Y axis is 0, that is: f x (t)=f y (t)=0; Therefore, the integral expressions of the initial output models of the accelerometer X and Y axes are transformed into: Among them, (w z (t)) 2 r x and (w z (t)) 2 r y is the lever arm error term, rx is the lever arm length in the X-axis direction, and ry is the lever arm length in the Y-axis direction; Since the lever arm error term is small, the lever arm error term is ignored; Therefore, the integral expressions of the initial output models of the accelerometer X and Y axes are transformed into: By smoothing the integral expression of the converted accelerometer X, Y initial output model, the zero bias error of the accelerometer X and Y axes can be obtained, that is:
9. The three-axis inertial sensor calibration method based on a single-degree-of-freedom servo motor according to claim 8, characterized in that: Step S5 specifically includes: S52, smoothing the output model after X-axis bias compensation or the output model after Y-axis bias compensation to obtain the smoothed output model after X-axis bias compensation or Y-axis bias compensation; integrating the absolute value of the smoothed output model after X-axis bias compensation or Y-axis bias compensation within an integer multiple period to obtain the component parameters of the earth's gravity on the plane formed by the X and Y axes; calculating the component parameters of the earth's gravity on the Z axis according to the component parameters of the earth's gravity on the plane formed by the X and Y axes; the specific process is as follows: The output model of the accelerometer after X-axis zero bias compensation is smoothed to obtain the smoothed output model of the accelerometer after X-axis zero bias compensation, that is: The absolute value of the smoothed output model of the accelerometer after X-axis zero bias compensation is integrated within an integer multiple period to obtain: Right now: Then the component parameter B of the earth's gravity on the plane formed by the X and Y axes is: Therefore, the component parameter A of the earth's gravity on the Z axis is: Alternatively, the output model of the accelerometer after Y-axis zero bias compensation is smoothed to obtain the smoothed output model of the accelerometer after Y-axis zero bias compensation, that is: The absolute value of the smoothed output model of the accelerometer Y-axis zero bias compensation is integrated within an integer multiple period to obtain: Right now: Then the component parameter B of the earth's gravity on the plane formed by the X and Y axes is: Therefore, the component parameter A of the earth's gravity on the Z axis is:
10. A three-axis inertial sensor calibration method based on a single-degree-of-freedom servo motor according to claim 9, characterized in that: Step S6 specifically includes: S62, averaging and smoothing the initial output model of the Z axis of the accelerometer to obtain the averaged smoothed output model of the Z axis; substituting the component parameter of the earth's gravity on the Z axis into the averaged smoothed output model of the Z axis to obtain the zero bias error of the Z axis of the accelerometer; the specific process is: The expression of the initial output model of the accelerometer Z axis is averaged to obtain the average output model of the accelerometer Z axis, that is: Among them, k is the number of revolutions of the servo motor, and n is the number of samples collected for each revolution of the servo motor; Because when the accelerometer Z axis rotates around the servo motor, the actual acceleration on the Z axis is 0, that is: f z (t)=0; Therefore, the expression of the accelerometer Z-axis average output model is transformed into: The transformed expression of the average output model of the accelerometer Z axis is smoothed to obtain the average smooth output model of the accelerometer Z axis, that is: Substituting the component parameter A of the earth's gravity on the Z axis into the average smoothed output model expression of the accelerometer Z axis, the zero bias error of the accelerometer Z axis can be obtained, that is: or
Citation Information
Patent Citations
Calibration compensation method for MEMS gyroscope by forward and reverse rotation method
CN114088118A
Gyroscope calibration method
CN117589203A
