ATTITUDE SELF-COMPENSATION METHOD TO THE TRANSMITTERS OF wMPS BASED ON INCLINOMETER
20200378792 ยท 2020-12-03
Assignee
Inventors
- Jiarui Lin (Tianjin, CN)
- Jigui Zhu (Tianjin, CN)
- Yongjie Ren (Tianjin, CN)
- Linghui Yang (Tianjin, CN)
- Siyang Guo (Tianjin, CN)
Cpc classification
G01C15/00
PHYSICS
G01C25/00
PHYSICS
International classification
G01C25/00
PHYSICS
Abstract
The present invention discloses an attitude self-compensation method to the transmitters of wMPS based on inclinometer, including the following steps: step 1: arranging inclinometer-combined transmitters according to the mechanism structure of the transmitters; step 2: building a horizontal reference frame based on an automatic level and guide rail; step 3: calibrating rotation relationship between the inclinometer and transmitter coordinate systems by referring to the horizontal reference frame according to the measurement model of the inclinometer and rotation measurement model of the transmitter; step 4: updating the orientation parameters of the transmitters in real time according to the output values of the inclinometer and compensation algorithm for the orientation parameters. The method of the present invention aims at self-compensating the orientation parameters of transmitters in real time and increasing the stability of the system. By the attitude change of the inclinometer, this method can compensate the attitude change of transmitters in real time, improve the stability of the measurement system, and adapt to the harsh environment.
Claims
1-6: (canceled)
7. An attitude self-compensation method to transmitters of wMPS based on inclinometer comprising the following steps: step 1: arranging inclinometer-combined transmitters according to mechanism structures of the transmitters; step 2: building a horizontal reference frame based on an automatic level and a guide rail; step 3: calibrating a rotation relationship between an inclinometer and a transmitter coordinate systems by referring to the horizontal reference frame according to a measurement model of the inclinometer and a rotation measurement model of the transmitter; step 4: updating orientation parameters of the transmitters in real time according to output values of the inclinometer and compensation algorithm for the orientation parameters.
8. The attitude self-compensation method to transmitters of wMPS based on inclinometer according to claim 1, wherein the steps of building a horizontal reference frame in step 2 are as follows: step 2-1: arranging an automatic level, and adjusting it by an optical composite image level to parallel the horizontal plane; step 2-2: arranging a plurality of spherical receivers and the corresponding spherical holders; step 2-3: arranging a lifting guide rail which is fixed with said spherical holders, replacing the spherical receivers with spherically mounted retro reflectors (SMR) of a laser tracker on the holders, adjusting the guide rail to ensure that the center of each SMR is in the same horizontal plane by using the automatic level, thus, finishing arrangements of target points on the horizontal reference plane; each SMR has a diameter of 1.5 inches; step 2-4: measuring target points and other points by the laser tracker and establishing a horizontal reference frame O.sub.h-x.sub.hy.sub.hz.sub.h in accordance with target points as xoy plane.
9. The attitude self-compensation method to transmitters of wMPS based on inclinometer according to claim 2, wherein each spherical holder has a diameter of 1.5 inches.
10. The attitude self-compensation method to transmitters of wMPS based on inclinometer according to claim 1, wherein the steps of calibrating a rotation relationship between an inclinometer and transmitter coordinate systems in Step 3 are as follows: step 3-1: arranging transmitters in front of the horizontal reference frame according to a measurement range of the transmitters, and measuring total target points of the horizontal reference frame by the transmitters; step 3-2: defining a transmitter coordinate system O.sub.t-x.sub.ty.sub.tz.sub.t, calculating rotation matrix from the transmitter coordinate system to the horizontal reference frame according to the measurement model of the transmitter, wherein a relationship between the two coordinates is as follows:
11. The attitude self-compensation method to the transmitters of wMPS based on inclinometer according to claim 1, wherein the step of updating orientation parameters of the transmitters in real time of step 4 are as follows: step 4-1: obtaining readings of the inclinometer in real time, calculating the rotation matrix from horizontal reference frame to inclinometer coordinate system; step 4-2: calculating an updated attitude matrix of the transmitter according to a calibrated rotation matrix from the transmitter coordinate system to the inclinometer coordinate system, compensating new attitude of the transmitter and obtaining an attitude compensation algorithm as follows:
(C.sub.T).sub.new=(R.sub.T.sup.I).sup.1.Math.(R.sub.H.sup.I).sub.new.Math.((R.sub.H.sup.I).sub.old).sup.1.Math.R.sub.T.sup.I.Math.(C.sub.T).sub.old Where (C.sub.T).sub.new, (C.sub.T).sub.old are a new transmitter coordinate system and an initial transmitter coordinate system, respectively; (R.sub.H.sup.I).sub.new, (R.sub.H.sup.I).sub.old are a new rotation matrix and an initial rotation matrix of the inclinometer, respectively.
12. The attitude self-compensation method to transmitters of wMPS based on inclinometer according to claim 1, wherein settling uncertainty accuracy of the automatic level is no more than 0.3, the standard deviation over a 1 km double run is no more than 1 mm.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0035]
[0036]
[0037]
[0038]
DETAILED DESCRIPTION OF THE EMBODIMENTS
[0039] The present invention will be further described accompanying with the figures.
[0040] The present invention combines the high-accuracy two-axis inclinometer into the transmitter of the wMPS, and provides a method for self-compensating the orientation parameters of transmitters in real time, calibrating a transmitter coordinate system and inclinometer coordinate system by space resection measurement method, compensating attitude of the transmitters in real time according to the attitude change variation of the inclinometer, thus enhancing the system robustness in the harsh environment.
[0041] The attitude self-compensation method to the transmitters based on inclinometer scanning of wMPS of the present invention is achieved by the following steps:
[0042] Step 1: as shown in
[0043] Step 2: as shown in
[0044] Arranging a plurality of spherical receivers having a diameter of 1.5 inches and the corresponding spherical holders; the dimension of the spherical receiver is same as that of SMR of the laser tracker so as to ensure the center of the receiver is at the same point after the replacement by the SMR; arranging a lifting guide rail which is fixed with said spherical holders, replacing the spherical receivers with SMRs of the laser tracker on the holders, wherein the center of the SMR is visible; adjusting the guide rail to ensure that the center of each SMR is in the same horizontal plane by using the automatic level, thus, finishing the arrangement of the target points on the horizontal reference plane;
[0045] Measuring target points and other points by the laser tracker and establishing the horizontal reference frame O.sub.h-x.sub.hy.sub.hz.sub.h in accordance with the target points as xoy plane;
[0046] As shown in
[0047] Step 3: as shown in
[0048] Where and are the readings, .sub.i and .sub.i are rotation angles around x and y axes, respectively;
[0049] And the equation of rotation matrix R.sub.H.sup.I from the horizontal reference frame to the inclinometer coordinate system is:
[0050] Where , is the rotation angle around z-axis in the rotation matrix;
[0051] Defining rotation matrix R.sub.T.sup.I from the transmitter coordinate system to the inclinometer coordinate system, and parameterizing the rotation matrix as follows:
[0052] Where r.sub.1. . . r.sub.9 are known parameters, and r.sub.i1 . . . r.sub.i9 are parameters to be solved;
[0053] Obtaining following equations according to rotation relationships among transmitter coordinate system, horizontal reference frame and inclinometer coordinate system:
[0054] Obtaining simultaneous equations via the above equations:
[0055] Regulating at least three attitudes of the transmitter by mechanical adjustment, solving the least squares solution of the linear equations to obtain r.sub.i1 . . . r.sub.i9, e.g. to obtain the rotation matrix from transmitter coordinate system to inclinometer coordinate system;
[0056] Constructing a non-linear optimization objective equation combining the orthogonal constraints of the rotation matrix and performing optimization solution via iterative algorithm to obtain the exact solution of the rotation matrix from transmitter coordinate system to inclinometer coordinate system;
[0057] Step 4: Obtaining readings of the inclinometer in real time; according to the calibrated rotation matrix from transmitter coordinate system to inclinometer coordinate system, calculating the updated rotation matrix of the transmitter attitude, compensating the transmitter attitude in real time and obtaining the attitude compensation algorithm as follows:
(C.sub.T).sub.new=(R.sub.T.sup.I).sup.1.Math.(R.sub.H.sup.I).sub.new.Math.((R.sub.H.sup.I).sub.old).sup.1.Math.R.sub.T.sup.I.Math.(C.sub.T).sub.old.
[0058] Consequently, the present invention achieves an attitude self-compensation method to the transmitters of wMPS based on inclinometer. By the high-accuracy attitude perception of the inclinometer, the method of the present invention compensates and updates the attitude of transmitters, which effectively avoids the attitude change of the transmitters caused by vibration or creep in harsh environments, and greatly improves the stability of the overall measurement field. The present invention satisfies the current high-accuracy and wide range measurement requirements and improves applicability of wMPS.
[0059] The inclinometer measurement model involved in the present invention can refer to the reference of Wen X., 2011 Research on error compensation of inclinometer in pose measurement of shield machine, Huazhong University of Science and Technology;
[0060] The transmitter measurement model involved in the present invention can refer to the reference of Yang L., 2010 Research on large-scale space coordinate measurement location technology based on optical scanning, Tianjin University;
[0061] The space resection measurement method involved in the present invention can refer to the reference of Liu X., 2014 Research on measurement and positioning method in large complex field, Tianjin University.
[0062] Although the functions and working processes of the present invention have been described above with reference to the accompanying drawings, the present invention is not limited thereto. The foregoing specific implementations are merely illustrative but not limiting. A person of ordinary skill in the art may make various forms under the teaching of the present invention without departing from the purpose of the present invention and the protection scope of the appended claims, and all the forms shall fall into the protection scope of the present invention.