A method for real-time calculation and data compensation of torsion angle of three-dimensional deformation monitoring instrument
By acquiring historical data sets and calculating torsion angles with magnetometer and recursive method, the measurement result deviation problem caused by flexible joint torsion of the three-dimensional deformation monitor is solved, and high-precision angle compensation and data accuracy are achieved, which expands the equipment Application scope.
Patent Information
- Application Number
- CN202411140254.3
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-20
- Publication Date
- 2024-11-26
- Estimated Expiration
- 2044-08-20
AI Technical Summary
During the measurement process, the existing three-dimensional deformation monitors have angular deviations in the measurement results due to flexible joint torsion, which lacks high-precision angle compensation capabilities, making it difficult to meet the needs of high-precision monitoring.
By obtaining historical data sets, using magnetometer data to calculate heading torsion angles, and combining recursive method to calculate recursive torsion angles, filtering abnormal data, building the final torsion angle data set, performing angle compensation of acceleration sensor data, and realizing torsion angle Real-time calculation and data compensation.
It improves the accuracy and accuracy of measurement, reduces the interference of geomagnetic changes on the measurement data, and enhances the application range and measurement capabilities of the equipment.
Smart Images

Figure CN118670339B_ABST
Abstract
Description
Technical Field
[0001] The invention relates to the field of geological disaster prevention, and in particular to a method for real-time calculation and data compensation of a torsion angle of a three-dimensional deformation monitoring instrument. Background Art
[0002] In the field of infrastructure construction and geological disaster prevention, the displacement of underground soil around key areas is an important part of monitoring. To ensure safety, it is generally necessary to organize personnel to conduct regular monitoring, but there are problems such as low efficiency, high labor costs, and poor work safety. With the continuous development of automated monitoring technology, this type of equipment can automatically measure parameters such as deep soil displacement and settlement in the monitoring area, which can improve the real-time nature of measurement results and reduce safety risks in key areas. Its application scenarios and application areas are also expanding.
[0003] As a commonly used automatic monitoring sensor, the array displacement meter is composed of multiple rigid sensor segments and flexible joints connected end to end. The sensor segment is equipped with an acceleration sensor, which calculates the current posture of the device by measuring the components of gravity on the three axes of the sensor in a static placement environment. Due to the coupling of the components on the three axes of the sensor, the existing array displacement meter can only measure the pitch angle and roll angle of the current segment, and lacks the ability to measure the heading angle.
[0004] A three-dimensional deformation monitor is disclosed in the patent with publication number CN115046523A. However, when the multi-section three-dimensional deformation monitor is arranged in the measuring hole along the gravity direction, the whole device is prone to axial torsion at the flexible joint due to factors such as installation. Figure 1 As shown in the figure, due to its influence, the measurement results of some segment sensors will have an angle deviation from the actual situation, which seriously affects the accuracy of the measurement results. Since the three-dimensional deformation monitoring instrument is developed based on an array displacement meter, a magnetic sensor is added to the sensor segment to cooperate with quaternion and other schemes to calculate the heading angle. Therefore, this method has a slow solution speed and poor solution effect for long-term data. The compensation effect is poor when measuring at a greater depth, and it is difficult to meet the needs of high-precision monitoring. Summary of the invention
[0005] In order to solve the problems in the prior art, the present invention provides a method for real-time calculation and data compensation of torsion angle of a three-dimensional deformation monitoring instrument with fast solution speed and high angle compensation result accuracy.
[0006] To this end, the present invention adopts the following technical solutions:
[0007] A method for real-time calculation and data compensation of torsion angle of a three-dimensional deformation monitoring instrument comprises the following steps:
[0008] S1, get the historical data set:
[0009] The historical data set includes Section Second Axis acceleration , Axis acceleration , Axis acceleration , x Axis magnetic field vector , y Axis magnetic field vector and the z-axis magnetic field vector ;in, , is the number of segments of the three-dimensional deformation monitor;
[0010] S2, use the magnetometer data to calculate the heading torsion angle:
[0011] The following formula is used to calculate the deformation of the three-dimensional deformation monitor. Segment in The heading angle at the time of measurement :
[0012] ;
[0013] Among them, the pitch angle ; Roll angle ; is the value of gravity acceleration;
[0014] By the heading angle The data set composed of the heading twist angle is calculated , we have the following formula:
[0015] ;
[0016] in, The first section of the three-dimensional deformation monitoring device is The heading angle when collecting data for the first time;
[0017] Solve all the heading twist angles Obtain a first data set;
[0018] S3, use the recursive method to solve the recursive torsion angle:
[0019] The following formula is used to calculate the deformation of the three-dimensional deformation monitor. Segment in The recursive torsion angle at the second measurement :
[0020] ;
[0021] in: ; ;
[0022] Solve for all recursive torsion angles , get the second data set; when of and The initial acceleration measured after each segment of the three-dimensional deformation monitoring device is set up;
[0023] S4, filter out abnormal data in the first data set:
[0024] Traversing the first data set, when the heading twist angle Appear , or , it will be added to the abnormal data set;
[0025] S5, constructing the final torsion angle dataset, comprising the following steps:
[0026] S51, extracting the segment number and acquisition times of the heading torsion angle in the abnormal data set, and searching for the corresponding recursive torsion angle in the second data set;
[0027] If the corresponding recursive torsion angle satisfies that the difference between it and the recursive torsion angle of the adjacent acquisition times or adjacent segments is less than 5°, then , then go to S52, otherwise go to S53;
[0028] S52, using the corresponding recursive torsion angle to replace the corresponding heading torsion angle in the first data set, and executing S54;
[0029] S53, calculate the degree of torsion angle deviation:
[0030] The deviation degree of the corresponding recursive torsion angle is calculated by the following two formulas: And the corresponding heading torsion angle deviation :
[0031] ;
[0032] ; , ;
[0033] use and replace the corresponding heading torsion angle in the first data set with the torsion angle corresponding to the smaller value in ;
[0034] S54, after all elements in the abnormal data set are screened through steps S51-S53, a final torsion angle data set is obtained, wherein the data in the final torsion angle data set is named ;
[0035] S6, correct the acceleration by torsion angle:
[0036] According to the final torsion angle data set obtained in step S5, angle compensation is performed using the following formula:
[0037] ;
[0038] in, For segment No. The measured The value of the axis acceleration after angle compensation; For segment No. The measured The value of the axis acceleration after angle compensation;
[0039] S7, calculate deformation:
[0040] Using S6 and The current deformation situation is obtained through multi-segment accumulation operation.
[0041] Preferably, the historical data set in step S1 is data collected by the three-dimensional deformation monitoring instrument within a period of three to six months.
[0042] Preferably, the three-dimensional deformation monitor in step S1 collects data once every 5 minutes to 1 day.
[0043] Preferably, S1 .
[0044] Preferably, the three-dimensional deformation monitor includes an acceleration sensor and a magnetic sensor, wherein the acceleration sensor uses a commercially available accelerometer ADXL203; and the magnetic sensor uses an electronic compass HMC5983 produced by Honeywell (China) Co., Ltd.
[0045] Compared with the prior art, the present invention has the following beneficial effects:
[0046] 1. The method of the present invention verifies the magnetic sensor data through the accelerometer data, and uses the torsion angle obtained by the recursive method to compensate the torsion angle calculated through the geomagnetic sensor data, thereby reducing the interference of geomagnetic changes on the magnetic sensor and the measurement data during the long-term measurement of the equipment and increasing the accuracy of the measurement.
[0047] 2. The data derivation method of the present invention can also be used for monitoring equipment that lacks magnetic sensors, thereby expanding the application scope of existing equipment and improving measurement accuracy and measurement capabilities. BRIEF DESCRIPTION OF THE DRAWINGS
[0048] Figure 1 A schematic diagram of the passive torsion state of an existing three-dimensional deformation monitoring device;
[0049] Figure 2 is a flow chart of the method of the present invention;
[0050] Figure 3 A schematic diagram of torsion angle compensation in the method of the present invention;
[0051] Figure 4 It is a schematic diagram of the principle of calculating the displacement direction angle in the method of the present invention. DETAILED DESCRIPTION
[0052] The technical solution of the present invention is further described in detail below in conjunction with the accompanying drawings.
[0053] The three-dimensional deformation monitoring device used in the method has the same structure as a three-dimensional deformation monitoring device disclosed in the patent with publication number CN115046523A. The number of segments of the three-dimensional deformation monitoring device in the present invention is 1-50.
[0054] like Figure 2 As shown, the method for real-time calculation of torsion angle and data compensation of the three-dimensional deformation monitoring instrument of the present invention specifically includes the following steps:
[0055] S1, get the historical data set:
[0056] Initialize the 3D deformation monitor, connect the data acquisition terminal, and set the number of each segment of the 3D deformation monitor; collect data within a period of 3 to 6 months. The 3D deformation monitor collects data at most once every 5 minutes under normal working conditions, and at least once a day. The collected data includes acceleration data and magnetometer data of all segments. Use the factory calibration file of the 3D deformation monitor to correct the collected data and obtain a historical data set. As the number of each segment of the three-dimensional deformation monitoring instrument, use As the number of acquisition times. In one embodiment of the present invention, the number of segments of the three-dimensional deformation monitoring instrument is 1-50.
[0057] The historical data set includes Section Second Axis acceleration , Axis acceleration , Axis acceleration , Axis magnetic field vector , Axis magnetic field vector and Axis magnetic field vector .
[0058] S2, using magnetometer data to calculate the heading torsion angle, includes the following steps:
[0059] S21, solve the pitch angle and roll angle:
[0060] Set the geographic coordinate system to The coordinate system is the North-East-Earth (NED) coordinate system, and the coordinate system of the three-dimensional deformation monitoring instrument is System, that is, the front-right-bottom coordinate system, the conversion matrix between the two coordinate systems As shown below:
[0061] ;
[0062] Among them, around The axis is the roll angle α, around The axis is the pitch angle β, around The axis is the heading angle θ. According to the relationship between gravity acceleration and geographic coordinate system, the relationship between the acceleration components of the current segment of the three-dimensional deformation monitoring instrument can be derived as follows:
[0063] ;
[0064] Arranging the above formula, we can get the first Segment in The pitch angle at the time of the measurement Roll Angle , as shown in the following two formulas:
[0065] ;
[0066] .
[0067] S22, calculate the heading angle:
[0068] Reading the magnetometer data, the current segment of the 3D deformation monitor can be obtained. Magnetic field strength in three axes; when the segment faces the geomagnetic south pole (i.e., near the geographic north pole), the magnetic field has components in the north and earth directions. The relationship between the magnetic field strength on the three axes of the magnetometer and the geomagnetic field is as follows:
[0069] ;
[0070] in, , , is the magnetometer three-axis output data of the current segment, is the north magnetic field vector, is the magnetic field vector in the direction of the Earth, is the transformation matrix. Simplifying this formula, we can get:
[0071] ;
[0072] By transforming the above equation, we can solve the first equation of the three-dimensional deformation monitoring instrument. Segment in The heading angle at the time of measurement , during the deformation process will be simplified, so it is not necessary to actually get The value of the deformation is as follows:
[0073] ;
[0074] The heading angle It is the angle value of the current segment of the three-dimensional deformation monitoring instrument relative to the magnetic north direction.
[0075] S23, calculate the heading torsion angle:
[0076] The heading angle obtained by S22 is used to solve the first Segment in The heading twist angle at the time of measurement , we have the following formula:
[0077] ;
[0078] in, The first section of the three-dimensional deformation monitoring instrument is The heading angle when collecting data for the first time.
[0079] Solve all the heading twist angles The heading torsion angle data set (the first data set) is obtained.
[0080] S3, use the recursive method to solve the recursive torsion angle:
[0081] When solving the torsion angle of each segment of the three-dimensional deformation monitoring instrument using the recursive method, The acceleration change trend on the two axes analyzes the current displacement direction, and the following formula is available:
[0082] ;
[0083] in, The first three-dimensional deformation monitoring instrument Segment in The displacement direction angle at the time of the measurement. of and It is the initial acceleration measured after each segment of the three-dimensional deformation monitoring instrument is set up.
[0084] In practical applications, the bottom segments, i.e., segments 1, 2, 3, and 4, are generally used as reference points for the displacement direction angle, and the reference displacement direction angle is calculated based on the reference points. When the reference displacement direction angle corresponding to the set of measurement data is The displacement direction angles of segments 1, 2, 3, and 4 in the secondary measurement data are analyzed, and the reference displacement direction angle is calculated using the following formula :
[0085] ;
[0086] Use the base displacement direction angle , solve the first Section The recursive torsion angle at the second measurement , as shown below:
[0087] ;
[0088] Solve for all recursive torsion angles , and obtain the recursive torsion angle data set (the second data set).
[0089] like Figure 4 As shown, in calculating the displacement direction angle When, segment No. An example of measurement results, marked in the figure as well as The two measurement results are The corresponding vector diagram in the plane, The axis corresponds to the acceleration value, and a dotted arrow line is used to connect the two points. This dotted line represents the acceleration value at the Measurement to The displacement direction corresponding to this segment in the measurement process, the displacement direction angle is the dotted line and The angle value of the axis angle. If any segment in the three-dimensional deformation monitoring instrument is twisted, the displacement direction derived from its measurement results will be different from that of other segments. The twist angle of the segment can be obtained by subtracting them.
[0090] S4, filter abnormal data in the heading torsion angle dataset:
[0091] The heading torsion angle data obtained in step S2 is traversed. When the heading torsion angle Appear , or , add it to the abnormal data set.
[0092] S5, constructing the final torsion angle dataset, comprising the following steps:
[0093] S51, extracting the segment number and acquisition times of the heading torsion angle in the abnormal data set, and searching for the corresponding recursive torsion angle in the recursive torsion angle data set of S3; if the recursive torsion angle satisfies:
[0094] ,
[0095] Then go to S52, otherwise go to S53;
[0096] S52, using the corresponding recursive torsion angle to replace the corresponding heading torsion angle in the heading torsion angle data set, and executing S54.
[0097] S53, calculate the degree of torsion angle deviation:
[0098] The corresponding recursive torsion angle deviation degree is calculated by the following two formulas And the corresponding heading torsion angle deviation :
[0099] ;
[0100] ; , ;
[0101] use and The torsion angle corresponding to the smaller value in replaces the corresponding heading torsion angle in the heading torsion angle data set.
[0102] The greater the calculated deviation, the worse the stability of the torsion angle calculated by the current method, and the worse the data credibility. Therefore, data with relatively small deviation is generally selected as the corresponding torsion angle.
[0103] S54, after filtering all the data in the abnormal data set using the methods of S51-S53, the sorted heading torsion angle data set is used as the final torsion angle data set, wherein the data in the final torsion angle data set is named .
[0104] S6, torsional angle compensation for acceleration:
[0105] According to the final torsion angle data set obtained in step S5, the following formula is used to calculate the torsion angle in the historical data set: Axis and The acceleration data of the axis is used to compensate the torsion angle:
[0106] ;
[0107] in, For segment No. The measured The value of the axis acceleration after angle compensation, For segment No. The measured The value of the axis acceleration after angle compensation, is the data in the final torsion angle data set.
[0108] S7, calculate deformation:
[0109] Using S6 and Solve each segment in axis, The displacement in the axial direction is calculated through multi-segment accumulation to obtain the current deformation data.
[0110] The method for real-time calculation and data compensation of torsion angle of three-dimensional deformation monitoring instrument of the present invention is mainly used for Figure 1 The multi-segment sensors shown in the figure have a problem of inconsistent coordinate systems due to relative torsion caused by the flexible joints, which results in large deviations in the measurement results. The method is mainly based on accelerometer and magnetic sensor data, and multiple groups of sensors are connected to each other to form a chain measurement device.
[0111] like Figure 1 As shown, the three-dimensional deformation monitor is connected by a flexible joint. Generally, the torsion angle corresponding to the bottom node is set to 0. When the upper sensor segment is twisted, the corresponding coordinate system is along Changes in the axis direction will affect the current segment acceleration sensor Axis and The axis output data is proportional to the overall vector magnitude, resulting in a change in the direction of the measured soil displacement.
[0112] like Figure 3 As shown, the torsion angle corresponds to θ in the figure, where The coordinate system can be set to the sensor coordinate system after the twist occurs. The coordinate system can be set to the sensor coordinate system when no torsion occurs. When the sensor is twisted, gravity is in the plane. The magnitude of the vector in the plane does not change, but its 、 The components on the axis change accordingly. Through the trigonometric relationship shown in the figure, we can use the twisted sensor to measure the results 、 Derived corresponding 、 , thereby achieving compensation for sensor torsion.
[0113] The three-dimensional deformation monitoring instrument generally selects the bottom segment sensor as segment 1. Considering the pressure of the upper equipment on the initial segment and the fixing effect of the fixing device at the bottom of the measuring hole on segment 1, it is generally believed that the torsion angle of this segment sensor is 0.
[0114] In one embodiment of the present invention, the three-dimensional deformation monitoring instrument uses a commercially available accelerometer ADXL203 as an acceleration sensor, and uses an electronic compass HMC5983 produced by Honeywell (China) Co., Ltd. as a magnetic sensor.
Claims
1. A method for real-time calculation and data compensation of torsion angle of a three-dimensional deformation monitoring instrument, characterized in that: The following steps are involved: S1, obtain historical data sets: The historical data set includes Section Second Axis acceleration , Axis acceleration , Axis acceleration , x Axis magnetic field vector , y Axis magnetic field vector and the z-axis magnetic field vector ;in, , is the number of segments of the three-dimensional deformation monitor; S2, use the magnetometer data to calculate the heading torsion angle: The following formula is used to calculate the deformation of the three-dimensional deformation monitor. Segment in The heading angle at the time of measurement : ; Among them, the pitch angle ; Roll angle ; is the value of gravity acceleration; By the heading angle The data set composed of the heading twist angle is calculated , we have the following formula: ; in, The first section of the three-dimensional deformation monitoring device is The heading angle when collecting data for the first time; Solve all the heading twist angles Obtain a first data set; S3, use the recursive method to solve the recursive torsion angle: The following formula is used to calculate the deformation of the three-dimensional deformation monitor. Segment in The recursive torsion angle at the second measurement : ; in: ; ; Solve for all recursive torsion angles , get the second data set; when of and The initial acceleration measured after each segment of the three-dimensional deformation monitoring device is set up; S4, filter out abnormal data in the first data set: Traversing the first data set, when the heading twist angle Appear , or , it will be added to the abnormal data set; S5, constructing the final torsion angle dataset, comprising the following steps: S51, extracting the segment number and acquisition times of the heading torsion angle in the abnormal data set, and searching for the corresponding recursive torsion angle in the second data set; If the corresponding recursive torsion angle satisfies: , Then go to S52, otherwise go to S53; S52, using the corresponding recursive torsion angle to replace the corresponding heading torsion angle in the first data set, and executing S54; S53, calculate the degree of torsion angle deviation: The deviation degree of the corresponding recursive torsion angle is calculated by the following two formulas: And the corresponding heading torsion angle deviation : ; ; , ; use and replace the corresponding heading torsion angle in the first data set with the torsion angle corresponding to the smaller value in ; S54, after all elements in the abnormal data set are screened through steps S51-S53, a final torsion angle data set is obtained, wherein the data in the final torsion angle data set is named ; S6, correct the acceleration by torsion angle: According to the final torsion angle data set obtained in step S5, angle compensation is performed using the following formula: ; in, For segment No. The measured The value of the axis acceleration after angle compensation; For segment No. The measured The value of the axis acceleration after angle compensation; S7, calculate deformation: Using S6 and The current deformation situation is obtained through multi-segment accumulation operation.
2. The method for real-time calculation of torsion angle and data compensation of a three-dimensional deformation monitoring instrument according to claim 1 is characterized in that: The historical data set in step S1 is data collected by the three-dimensional deformation monitoring instrument within a period of three to six months.
3. The method for real-time calculation of torsion angle and data compensation of a three-dimensional deformation monitoring instrument according to claim 1 is characterized in that: The three-dimensional deformation monitor in step S1 collects data every 5 minutes to 1 day.
4. The method for real-time calculation of torsion angle and data compensation of a three-dimensional deformation monitoring instrument according to claim 1, characterized in that: In S1 .
5. The method for real-time calculation of torsion angle and data compensation of a three-dimensional deformation monitoring instrument according to claim 1, characterized in that: The three-dimensional deformation monitoring instrument includes an acceleration sensor and a magnetic sensor. The acceleration sensor is an acceleration sensor ADXL203; the magnetic sensor uses an electronic compass HMC5983.
