A measuring prism with inertial autonomous positioning capability and a prism tracking method
By integrating an inertial navigation system on the prism, the position, speed and attitude of the prism are calculated independently, and data fusion is carried out with the total station, the tracking limitations of the total station in terms of observation environment and occlusion are solved, and the tracking of the prism is improved and the ability to follow the user experience and practicality.
Patent Information
- Application Number
- CN202211349601.4
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-10-31
- Publication Date
- 2024-12-06
- Estimated Expiration
- 2042-10-31
AI Technical Summary
The existing automatic tracking total station has limitations in the observation environment, occlusion, distance between the prism and the total station, and relative motion speed, making it difficult to achieve robust prism tracking and inspection.
The prism system based on the inertial navigation system is adopted, including optical prism, autonomous positioning and posture module and communication module. The position, speed and attitude of the prism are calculated independently through the inertial measurement unit and the data processing unit, and are carried out through wireless communication and total station. Data transmission and fusion assists the total station for robust tracking.
It effectively improves the tracking and calibration capabilities of the prism, reduces the search radius of the total station, improves the recapture and continuous tracking capabilities after occlusion, and improves the user experience and practicality.
Smart Images

Figure CN115752395B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of surveying and mapping technology and equipment, and in particular to a measuring prism based on an inertial navigation system and having the capability of autonomous position and posture calculation. Background Art
[0002] A total station is a surveying and mapping instrument that integrates horizontal angle, vertical angle, and distance measurement functions. It usually needs to be used with a prism for point measurement. Traditional total stations do not have the function of automatically aiming at the prism. When using it, you need to manually aim the prism for measurement, which is time-consuming and labor-intensive, and the prism cannot be dynamically tracked. In order to overcome the above defects, many surveying instrument manufacturers, represented by Leica Geosystems, have added the function of automatic prism tracking and aiming on the basis of traditional total stations, realizing the automated measurement of total stations.
[0003] The existing mainstream automatic tracking total station mainly realizes dynamic tracking and aiming of the prism through image recognition, and the prism itself does not have the ability to calculate the position. This method has the following defects: 1) The prism and the total station need to maintain good continuous line of sight. Once there is an obstruction, it is easy to cause the total station to interrupt the automatic tracking of the prism. 2) The movement speed of the prism relative to the total station cannot be too fast, otherwise it is easy to cause the total station to fail to track. 3) The distance between the prism and the total station is limited. It is difficult to track if it is too far or too close. 4) The observation environment is demanding, and effective continuous tracking and aiming can only be carried out under sufficient light.
[0004] The patent with publication number "CN110220512A" is named "A dynamic positioning system of a total station combined with an inertial measurement unit". This patent installs a prism and an inertial measurement unit on a carrier, and uses the combination of a total station and an inertial measurement unit for dynamic positioning. However, this patent only uses the prism as a cooperative target of the total station to measure the position coordinates of the carrier. Therefore, the prism itself in this solution does not have the ability to calculate the position, and it cannot improve the tracking and aiming ability of the total station to the prism, which is essentially different from this patent.
[0005] In view of the existing problems, a prism tracking solution is urgently needed to overcome the limitations of observation environment, occlusion, distance between prism and total station, and relative motion speed. To this end, the present invention proposes a new prism system and method based on inertial navigation technology. The prism has the ability to autonomously calculate the position, speed and attitude, which can effectively solve the technical problems of dynamic tracking and aiming of prisms in existing automatic tracking total stations. Summary of the invention
[0006] In view of the deficiencies in the prior art, the present invention proposes a prism system and method based on inertial navigation system (INS) technology, by which the position of the prism is estimated by the INS, thereby achieving continuous tracking of the prism by a total station.
[0007] In order to achieve the above-mentioned object, the present invention proposes a measuring prism with inertial autonomous positioning capability, comprising an optical prism, an autonomous positioning and attitude determination module and a communication module, wherein the autonomous positioning and attitude determination module is fixedly connected to the optical prism;
[0008] The optical prism is used in conjunction with the total station, which can measure the position coordinates of the center of the prism under line of sight. The autonomous positioning and attitude module, including the inertial measurement unit IMU and the data processing unit, can autonomously calculate the three-dimensional position, speed and attitude information of the prism given the initial position, speed and attitude information.
[0009] The inertial measurement unit is used to measure the three-axis angular velocity vector and the three-axis non-gravitational acceleration of the carrier;
[0010] The data processing unit is used to fuse and process the IMU raw data and the prism center coordinates measured by the total station, realize combined positioning and attitude determination, and obtain the prism position, speed and attitude estimation results;
[0011] The communication module is used for wireless communication and data transmission between the optical prism and the total station. The positioning and attitude results obtained by the data processing unit at the optical prism are transmitted to the total station through the communication module to assist the total station in predicting the prism position. Under line of sight conditions, the prism coordinates measured by the total station are sent to the data processing unit of the prism in real time through the communication module.
[0012] Furthermore, the inertial measurement unit is composed of three gyroscopes and three accelerometers.
[0013] Moreover, the wireless communication form between the optical prism and the total station is WIFI or Bluetooth.
[0014] The present invention also provides a prism tracking method implemented by the above-mentioned measuring prism with inertial autonomous positioning capability, comprising the following steps:
[0015] Set up the total station and prism, aim the total station at the prism, and record the measurement data of the IMU and the total station synchronously with the data processing unit in chronological order;
[0016] Initialize the position, speed and attitude of the autonomous positioning and attitude determination module at the optical prism;
[0017] Move the prism and perform inertial navigation calculation on the acquired IMU data to obtain the prism position, velocity, attitude, acceleration and angular velocity information;
[0018] When the total station and the prism are in line of sight, the total station tracks and sights the prism, measures the position coordinates of the prism in real time, sends the position coordinates to the data processing unit of the prism through the communication module, and fuses the data with the prism positioning and attitude determination results obtained by inertial navigation to obtain the prism combined positioning and attitude determination results;
[0019] The data processing unit of the prism predicts the position, speed and attitude information of the prism through the inertial navigation solution, and assists the total station to track the prism more robustly;
[0020] When the total station stops tracking the prism, the total station predicts the position of the prism based on the received prism prediction positioning and attitude information, aims at the predicted position, and searches for the prism in the nearby range so that it can re-aim and track the prism.
[0021] Furthermore, the position coordinates of the prism are measured using a total station to initialize the position.
[0022] Moreover, the speed initialization is achieved by setting the prism to be stationary and setting the initial speed of the prism to 0; or calculating the speed by using the difference between the prism positions at two moments.
[0023] Moreover, the attitude initialization is implemented by static analytical coarse alignment or dynamic alignment.
[0024] Moreover, the fusion of total station observations and inertial navigation solution results is achieved through Kalman filtering or graph optimization.
[0025] Compared with the prior art, the present invention has the following beneficial effects:
[0026] Since the optical prism has the ability to independently calculate its position, speed and attitude, it can effectively calculate its own position, speed, attitude and other state quantities in real time and transmit them to the total station, which can effectively reduce the search radius of the total station and effectively improve the prism's re-capture and continuous tracking capabilities after occlusion.
[0027] The solution of the present invention is simple and convenient to implement, has strong practicality, solves the problems of low practicality and inconvenience in actual application existing in related technologies, can improve user experience, and has important market value. BRIEF DESCRIPTION OF THE DRAWINGS
[0028] Figure 1 is a schematic diagram of the system composition of the prism according to an embodiment of the present invention;
[0029] Figure 2 Schematic diagram of the system operation when the total station and the prism are in line of sight according to an embodiment of the present invention;
[0030] Figure 3 is a schematic diagram of re-tracking a prism after line of sight is interrupted (occluded) according to an embodiment of the present invention;
[0031] In the figure, 1 is prism; 2 is communication module; 3 is inertial measurement unit (IMU); 4 is data processing unit; 5 is total station; 6 is predicted position of prism; 7 is search range of prism. DETAILED DESCRIPTION
[0032] The technical solution of the present invention is described in detail below with reference to the accompanying drawings and embodiments.
[0033] A measuring prism with inertial autonomous positioning capability according to an embodiment of the present invention comprises an optical prism 1, an autonomous positioning and attitude determination module and a communication module 2. The optical prism is used in conjunction with a total station, and the total station can measure the position coordinates of the center of the prism under line of sight.
[0034] Among them, the autonomous positioning and attitude module includes an inertial measurement unit 3 (IMU) and a data processing unit 4. Given the initial position, speed and attitude information, it can autonomously calculate the three-dimensional position, speed and attitude information of the prism. In specific implementation, the prism and the IMU are fixedly connected, and the inertial measurement unit 3 (IMU) and the data processing unit 4 are connected to form an autonomous positioning and attitude module, and the autonomous positioning and attitude module is connected to the communication module. The inertial measurement unit 3 is composed of three gyroscopes and three accelerometers, which are used to measure the three-axis angular velocity vector and three-axis non-gravitational acceleration of the carrier. The original measurement value of the IMU is time-synchronized with the local crystal oscillator of the data recording system as a reference, and a time tag is added.
[0035] The data processing unit 4 is used to fuse and process the IMU raw data and the prism center coordinates measured by the total station to achieve combined positioning and attitude determination. The data processing unit 4 can be implemented using existing chips such as CPU.
[0036] The communication module 2 is used for wireless communication and data transmission between the optical prism and the total station. The positioning and attitude results obtained by the data processing unit 4 at the optical prism are transmitted to the total station through the communication module 2 to assist the total station in predicting the position of the prism. Under the condition of line of sight, the coordinates of the prism measured by the total station are sent to the data processing unit of the prism in real time through the communication module.
[0037] The communication forms include but are not limited to WIFI, Bluetooth, etc.
[0038] In the embodiment, the communication module 2 realizes wireless communication and data transmission between the optical prism and the total station 5 via WiFi.
[0039] For specific operation methods, see Figure 2 , Figure 3 The prism tracking method implemented by the embodiment of the present invention according to the above measuring prism comprises the following specific steps:
[0040] 1) Fix the prism on the measuring rod, set up the total station 5 and aim at the prism to measure the three-dimensional position coordinates of the prism in real time. Then perform data acquisition and start the data processing unit.
[0041] After the arrangement is completed, the position, speed and attitude of the autonomous positioning and attitude determination module at the optical prism need to be initialized. In specific implementation, the position coordinates of the prism can be measured by a total station to achieve position initialization. There are many ways to initialize the speed, including but not limited to making the prism still and setting the initial speed of the prism to 0; or, using the difference between the prism positions at two moments to calculate the speed. There are many ways to initialize the attitude, including but not limited to static analytical coarse alignment, dynamic alignment, etc.
[0042] 2) Hold the measuring rod with the tip touching the ground, and use the accelerometer output in the IMU to determine the initial roll and pitch angles.
[0043] Assume that the initial pitch angle is θ, the initial roll angle is φ, and the outputs of the accelerometer x, y, and z axes during the static period are a and x , a y , a z , let the normal gravitational acceleration be g, then the calculation formula for the pitch angle is
[0044]
[0045] The formula for calculating the roll angle is:
[0046]
[0047] 3) Set a rough heading angle. Touch the tip of the rod to the ground and shake the measuring rod. Perform inertial navigation calculation on the acquired IMU data to obtain a trajectory line, and use the total station 5 to measure the prism to obtain another trajectory line. The angle between the two trajectory lines is the heading angle error. Subtracting the heading angle error from the rough heading angle can correct the error, that is, obtain a more accurate heading angle.
[0048] 4) When the rod tip touches the ground and there is no relative sliding, the rod tip speed can be considered to be zero, that is, Since the IMU is rigidly connected to the tip of the pole, the initial velocity of the IMU The speed arm effect compensation formula can be obtained by projecting the tip speed, so we have
[0049]
[0050] in, is the projection of the Earth's rotation angular velocity in the n system, is the projection of the Earth's rotation angular velocity in system b, is the direction cosine matrix corresponding to the posture, is the IMU gyroscope output, is the projection of the arm vector from the IMU center to the point where the tip of the rod touches the ground in the b system, and × represents taking the antisymmetric matrix.
[0051] 5) Move the measuring rod and perform inertial navigation calculation on the acquired IMU data to obtain information such as the position, velocity, attitude, acceleration and angular velocity of the prism. This step can be implemented using existing technology and will not be described in detail.
[0052] 6) When the total station 5 is in line of sight with the prism, the total station 5 tracks and aims at the prism, measures the position coordinates of the prism in real time, sends the position coordinates to the data processing unit of the prism through the communication module, and performs data fusion with the prism positioning and attitude determination results obtained by inertial navigation solution in the form of Kalman filtering to obtain the combined positioning and attitude determination results of the prism.
[0053] In the specific implementation, the Kalman filtering method can refer to the existing technology, and the present invention will not elaborate on it. The implementation method of fusing the total station observation value with the inertial navigation solution result includes but is not limited to Kalman filtering, graph optimization, etc.
[0054] 7) When the total station 5 is in line of sight with the prism, the current position and speed of the total station prism predicts the position of the prism at the next moment, and assists the total station to adjust the angle in advance (see step 9) so that it can track the sighting prism more robustly.
[0055] The prediction method proposed by the present invention is to assume that the current position of the prism at time (t) is r n (t), with a velocity of v n (t), the time interval is Δt, then the position of the prism at the next moment (t+Δt) can be predicted as
[0056] r n (t+Δt)=r n (t)+v n (t)Δt (4)
[0057] 8) When the total station stops tracking the prism, the prism moves to a position where it has line of sight with the total station and performs zero-speed correction, that is, the zero speed is used as the observation value for Kalman filter measurement update to slow down the error divergence of inertial navigation. In specific implementation, the user holding the measuring rod can adjust the position of the prism.
[0058] 9) The data processing unit calculates the rotation angle of the total station according to the orientation of the total station and the prism position at the current moment.
[0059] Assume that the coordinates of the center of the prism are (E, N, U, ) and the azimuth of the total station is α H , the altitude angle is α v , then the horizontal angle Δα required for the total station to rotate H and the altitude angle ΔαV for
[0060]
[0061] Among them, E, N, and U refer to east, north, and height respectively, which are used to describe the position of the prism in the coordinate system with the total station as the coordinate origin.
[0062] 10) According to the result obtained in step 9), after the total station is rotated to the specified angle, the total station search range 7 is set according to the uncertainty of the prism position, and the total station searches for the prism within the specified range.
[0063] Assume the slant distance between the prism and the total station is d s , the error in the horizontal position of the prism predicted by the Kalman filter is σ H , the vertical position error is σ V , then the horizontal search range of the prism is
[0064]
[0065] Vertical search range
[0066]
[0067] 11) If the total station 5 finds a prism within the search range 7, then steps 6-7 are repeated; if no prism is found, then steps 8-10 are repeated.
[0068] In specific implementation, the method proposed in the technical solution of the present invention can be automatically run by those skilled in the art using computer software technology. System devices for implementing the method, such as a readable storage medium storing the corresponding computer program of the technical solution of the present invention and a device for running the corresponding computer program, should also be within the scope of protection of the present invention.
[0069] The specific embodiments described herein are merely examples of the spirit of the present invention. Those skilled in the art may make various modifications or additions to the specific embodiments described or replace them in similar ways, but they will not deviate from the spirit of the present invention or exceed the scope defined by the appended claims.
Claims
1. A measuring prism with inertial autonomous positioning capability, Features: It includes an optical prism, an autonomous positioning and posture determination module and a communication module, wherein the autonomous positioning and posture determination module is fixedly connected to the optical prism; The optical prism is used in conjunction with the total station, which can measure the position coordinates of the center of the prism under line of sight. The autonomous positioning and attitude module, including the inertial measurement unit IMU and the data processing unit, can autonomously calculate the three-dimensional position, speed and attitude information of the prism given the initial position, speed and attitude information. The inertial measurement unit is used to measure the three-axis angular velocity vector and the three-axis non-gravitational acceleration of the carrier; The data processing unit is used to fuse and process the IMU raw data and the prism center coordinates measured by the total station, realize combined positioning and attitude determination, and obtain the prism position, speed and attitude estimation results; The communication module is used for wireless communication and data transmission between the optical prism and the total station. The positioning and attitude results obtained by the data processing unit at the optical prism are transmitted to the total station through the communication module to assist the total station in predicting the prism position. Under line of sight conditions, the prism coordinates measured by the total station are sent to the data processing unit of the prism in real time through the communication module.
2. The measuring prism with inertial autonomous positioning capability according to claim 1, Features: The inertial measurement unit is composed of three gyroscopes and three accelerometers.
3. The measuring prism with inertial autonomous positioning capability according to claim 1, Features: The wireless communication between the optical prism and the total station is in the form of WIFI or Bluetooth.
4. A prism tracking method implemented by a measuring prism with inertial autonomous positioning capability according to claim 1, 2 or 3, Features: The following steps are included: Set up the total station and prism, aim the total station at the prism, and record the measurement data of the IMU and the total station synchronously with the data processing unit in chronological order; Initialize the position, speed and attitude of the autonomous positioning and attitude determination module at the optical prism; Move the prism and perform inertial navigation calculation on the acquired IMU data to obtain the prism position, velocity, attitude, acceleration and angular velocity information; When the total station and the prism are in line of sight, the total station tracks and sights the prism, measures the position coordinates of the prism in real time, sends the position coordinates to the data processing unit of the prism through the communication module, and fuses the data with the prism positioning and attitude determination results obtained by inertial navigation to obtain the prism combined positioning and attitude determination results; The data processing unit of the prism predicts the position, speed and attitude information of the prism through the inertial navigation solution, and assists the total station to track the prism more robustly; When the total station stops tracking the prism, the total station predicts the position of the prism based on the received prism prediction positioning and attitude information, aims at the predicted position, and searches for the prism in the nearby range so that it can re-aim and track the prism.
5. The prism tracking method implemented by the measuring prism with inertial autonomous positioning capability according to claim 4, Features: The position coordinates of the prism are measured using a total station to initialize the position.
6. The prism tracking method implemented by the measuring prism with inertial autonomous positioning capability according to claim 4, Features: The speed initialization is achieved by setting the prism to be stationary and setting the initial speed of the prism to 0; or calculating the speed by using the difference between the prism positions at two moments.
7. The prism tracking method implemented by the measuring prism with inertial autonomous positioning capability according to claim 4, Features: The attitude initialization is implemented by static analytical coarse alignment or dynamic alignment.
8. A prism tracking method implemented by a measuring prism with inertial autonomous positioning capability according to claim 4, 5, 6 or 7, Features: The fusion of total station observations and inertial navigation solution results is achieved through Kalman filtering or graph optimization.
Citation Information
Patent Citations
Dynamic positioning system of total station combined inertial measurement unit
CN110220512A
Heading machine positioning and navigation system and positioning and navigation method
CN114689045A
Coal cutter positioning calibration system based on RTK-GNSS and total station and application method
CN114739425A
Three-Dimensional Measuring Method And Surveying System
US20150116693A1
