A pipe jacking guiding and positioning device and positioning method based on integrated navigation system
By combining optical fiber inertial guide, odometer and static level in the pipe heading guide system, using Kalman filtering technology to integrate information, the existing technology cannot meet the guidance of small diameter, large elevation, long distance and large curvature pipe heading projects. Accuracy and automation requirements enable high-precision and low-cost pipe-top guide solutions.
Patent Information
- Application Number
- CN202211189735.4
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-09-28
- Publication Date
- 2024-11-26
- Estimated Expiration
- 2042-09-28
AI Technical Summary
The existing pipe-pipe guide method cannot meet the needs of small diameter, large elevation, long distance and large curvature pipe-pipe projects. In particular, the laser guidance method and total station method have large measurement errors, low degree of automation, high cost and inapplicable Due to the problem of curved top tubes, fiber gyroscope inertial navigation technology lacks GPS information support in underground construction and is difficult to directly apply.
Using a tube guide device based on a combined navigation system, including fiber inertial guide, odometer and static level, the error equations of the error model, speed, position and attitude parameters of the gyroscope and accelerometer are integrated using Kalman filtering technology Multi-source information can realize error compensation and accuracy improvement of fiber inertial guide measurement data, and is suitable for underground construction environments.
Improve the measurement accuracy of the attitude and axis deviation of the pipe header, realize high-precision guidance for pipe header construction without GPS information, reduce system cost and operation complexity, and is suitable for small diameter, large elevation, and long Pipe hoisting engineering with distance and high curvature.
Smart Images

Figure CN115683095B_ABST
Abstract
Description
Technical Field
[0001] The invention relates to the field of trenchless technology, and in particular to a pipe jacking guide positioning device and a positioning method based on a combined navigation system. Background Art
[0002] During the pipe jacking construction process, the pipe jacking guidance technology ensures that the underground pipeline is always laid along the direction of the planned line and that the pipe jacking machine can be smoothly advanced to the receiving well. The important parameters of the pipe jacking guidance are the posture and axis deviation of the pipe jacking machine. The driller can accurately understand the current posture and axis deviation of the pipe jacking machine through these data, and adjust the thrust of each point of the propulsion cylinder or the angle of the cutting disc, and finally, advance it efficiently and safely according to the pre-designed planned route.
[0003] The methods currently used for pipe jacking guidance are manual visual inspection, laser guidance and total station. Manual visual inspection has large measurement errors and low automation, which affects construction efficiency and quality. Therefore, in recent years, in order to improve guidance accuracy and automation, laser guidance and total station methods have been widely used in large-diameter straight pipe jacking construction.
[0004] The measuring instrument used in the laser guidance method is generally a laser theodolite, which can emit a red laser beam with concentrated energy and visible to the naked eye. The offset distance of the laser beam on the target is used to determine whether the jacking track has deviated. When a deviation occurs, the correction cylinder is used to correct the deviation. Many companies and institutions at home and abroad have developed relatively mature laser guidance systems, which are well applied in short-distance straight jacking projects, and the system has been further optimized, with a maximum length of 250m. However, the laser guidance method is only applicable to straight jacking projects, and the guidance distance is short. In long-distance jacking construction, the laser spot will diverge and fail.
[0005] The measurement principle of the total station method is the wire measurement principle. The coordinates of the wire points are measured by controlling the total station through a computer, and the coordinates of the machine head are finally obtained by transmitting them station by station, and the machine head deviation is obtained. This guidance method can be used for curve jacking, and the measurement distance can be increased by increasing the number of total stations. At present, the total station guidance method at home and abroad has been increasingly improved and optimized, and has also been successfully applied to large-diameter curved pipe jacking projects. However, the pipe diameter of most pipe jacking construction is generally not very large, and the operable space in the pipe is extremely narrow, which will cause extremely unfavorable observation conditions, bring many inconveniences to practical applications, and reduce the guidance efficiency. The total station guidance system currently on the market is expensive, even exceeding the cost of the entire project, and during the construction process, multiple total station technicians are required, so it is not widely used. With the increasing number of small-diameter, high-elevation, long-distance and large-curvature pipe jacking projects, the traditional pipe jacking guidance method is increasingly unable to meet its urgent needs.
[0006] Fiber optic gyro inertial navigation technology has the characteristics of high output information, high reliability, small size and low cost. It can introduce external auxiliary information (such as GPS, odometer, etc.) to meet the accuracy requirements of long-term work. It has a large number of applications in various military and civilian systems such as aircraft, ships, sounding rockets, and vehicle navigation and positioning. It is relatively mature and mostly uses a combined navigation solution of inertial navigation system / GPS / altimeter. However, pipe jacking construction is underground for a long time and there is no GPS information. The combined navigation method that has been maturely applied in the aerospace field cannot be directly transplanted to the pipe jacking guidance technology. Summary of the invention
[0007] In view of the above analysis, the embodiments of the present invention aim to provide a pipe jacking guidance and positioning device and a positioning method based on a combined navigation system, so as to solve the problem that the existing pipe jacking guidance method cannot meet the requirements and the fiber optic gyro inertial navigation technology cannot be directly applied to the pipe jacking guidance technology.
[0008] On the one hand, the present invention provides a pipe jacking guiding and positioning device based on a combined navigation system, comprising a host computer, a compensation water tank, and an odometer, a fiber optic inertial navigation system and a static level connected to the host computer, the static level comprising a first static level and a second static level, the odometer being arranged above the pipe segment at the entrance of a working well, the fiber optic inertial navigation system being arranged in the head of the pipe jacking machine, the first static level being located in the head of the pipe jacking machine as a measuring point, the second static level being located outside the pipe segment as a reference point, and the first static level, the second static level and the compensation water tank being connected via an air pipe and a liquid pipe.
[0009] Furthermore, the odometer measures the distance increment of the pipe segment jacking per unit time, and projects and accumulates the distance increment on the navigation coordinate system to obtain the position information.
[0010] Furthermore, the height information of the static level is obtained by changing the hydraulic pressure of the first static level relative to the second static level according to the liquid density and the gravitational acceleration.
[0011] On the other hand, the present invention provides a positioning method for a pipe jacking guide positioning device based on an integrated navigation system, the steps comprising:
[0012] Step 1: Establish the error model of FOG gyroscope and accelerometer;
[0013] Step 2: Establish error equations for velocity, position, and attitude parameters;
[0014] Step 3: Determine the state variables and state equations according to the error models of the gyroscope and accelerometer and the error equations of the velocity, position, and attitude parameters;
[0015] Step 4: Establish measurement and measurement equations based on the zero speed information and zero angular speed information measured when the pipe section is stationary during pipe jacking replacement, the position information measured by the odometer, the height information calculated by the static level, and the position information calculated by the fiber optic inertial navigation system;
[0016] Step 5: Discretize the continuous-time system in the Kalman filter equation;
[0017] Step 6: Solve the Kalman filter equation, compensate the gyro and accelerometer output data according to the solution results, and obtain attitude and position information.
[0018] Furthermore, in step 1, the gyro error model is:
[0019]
[0020] in, are the ideal values of the x, y, and z axis gyroscopes, respectively; They are the zero bias of the gyroscope x, y, and z axes in the carrier coordinate system; are the x, y, and z axis gyro measurement values respectively; K gx , K gy , K gz are the gyro x, y, and z axis scale factors respectively; δK gx ,δK gy ,δK gz are the gyro x, y, and z axis scale factor errors respectively; M ij is the misalignment angle of the gyroscope j-axis toward the i-axis.
[0021] Furthermore, in step 1, the accelerometer error model is:
[0022]
[0023] in, are the ideal values of the accelerometer x, y, and z axes respectively; They are the zero bias of the accelerometer x, y, and z axes in the carrier coordinate system; are the x-, y-, and z-axis measurement values of the accelerometer respectively; K Ax , K Ay , K Az are the x, y, and z axis scale factors of the accelerometer respectively; δK Ax ,δK Ay ,δK Az are the scale factor errors of the accelerometer in the x, y, and z axes respectively; A ij is the misalignment angle of the accelerometer j axis toward the i axis.
[0024] Furthermore, in step 2, the speed error equation is:
[0025]
[0026] Among them, v E 、v N 、v U The velocities in the east, north and sky directions in the navigation calculation coordinate system are δv E ,δv N ,δv U They are the velocity errors in the east, north and celestial directions in the navigation calculation coordinate system respectively; are the inclination, roll and azimuth errors in the navigation calculation coordinate system respectively; L is the latitude of the FOINS location; δL is the latitude error of the FOINS location; h is the height of the FOINS location; ω ie is the angular velocity of the Earth's rotation; are the zero bias of the accelerometer x, y, and z axes in the navigation calculation coordinate system; R M R is the principal radius of curvature of the Earth's meridian; N It is the principal radius of curvature of the Earth's circumplex.
[0027] Furthermore, in step 2, the position error equation is:
[0028]
[0029] Wherein, L, λ, h are the latitude, longitude and depth of the earth where the fiber-optic inertial navigation system is located; δL, δλ, δh are the latitude error, longitude error and altitude error.
[0030] Furthermore, in step 2, the posture error equation is:
[0031]
[0032] in, is the error of the inclination angle, is the error of the rolling angle, is the azimuth error; is the Earth's rotation angular rate; is the displacement angular velocity; They are the zero bias of the gyroscope x, y, and z axes in the navigation coordinate system.
[0033] Furthermore, in step 6, the accelerometer output data is compensated:
[0034]
[0035] Compensate the gyro output data:
[0036]
[0037] Compared with the prior art, the present invention can achieve at least one of the following beneficial effects:
[0038] (1) Aiming at the characteristics of pipe jacking construction, the present invention applies inertial navigation technology to pipe jacking construction for the first time, and proposes to use the distance information of the odometer, the zero speed and zero angular velocity information at rest, and the height information of the static level as external information sources to correct and compensate the error of the inertial measurement method of FOG (Fiber Optic Gyroscope). The present invention can make full use of the complementary characteristics of the information of the fiber optic gyroscope, the odometer, and the static level, give play to their respective advantages, and make up for their respective shortcomings.
[0039] (2) The present invention integrates the distance information of the fiber optic gyroscope, the odometer and the height information of the static level, and uses the Kalman filter technology to optimally estimate the jacking pipe trajectory parameters such as the inclination error, the roll angle error, the azimuth error, etc., so as to compensate for the height channel of the fiber optic gyroscope measurement system that diverges rapidly over time and the speed parameters and position parameters that are continuously accumulated with the integral calculation, thereby improving the measurement accuracy of the attitude and axis deviation of the jacking pipe tunneling machine.
[0040] (3) The present invention aims at underground construction without external information such as GPS, and takes advantage of the characteristics of pipe jacking construction. In the process of stopping excavation and lowering new pipe sections, the zero-speed state is judged in real time based on the measurement values of the accelerometer and gyroscope. When it is detected that the pipe jacking machine is in the zero-speed state, the gyroscope zero bias calculation and compensation are performed, thereby realizing combined navigation.
[0041] (4) The multi-source information fusion process of the present invention adopts a sequential filtering method to ensure real-time calculation and meet the requirements of instant access and exit of each navigation source.
[0042] In the present invention, the above-mentioned technical solutions can also be combined with each other to achieve more preferred combination solutions. Other features and advantages of the present invention will be described in the subsequent description, and some advantages can become obvious from the description, or can be understood by practicing the present invention. The purpose and other advantages of the present invention can be realized and obtained through the contents particularly pointed out in the description and the drawings. BRIEF DESCRIPTION OF THE DRAWINGS
[0043] The drawings are only for the purpose of illustrating particular embodiments and are not to be considered limiting of the present invention. Like reference symbols denote like components throughout the drawings.
[0044] Figure 1 It is a schematic diagram of the installation of each sensor in the jacking pipe guiding and positioning device;
[0045] Figure 2 It is a schematic diagram of the basic principle of Kalman filter;
[0046] Figure 3 Update calculation principle for dead reckoning position information;
[0047] Figure 4 The figure is a flow chart of the pipe jacking guidance and positioning method.
[0048] Reference numerals:
[0049] 1-host computer; 2-odometer; 3-fiber optic inertial navigation; 4-segment; 5-first static level; 6-second static level; 7-compensating water tank; 8-pipe jacking machine. DETAILED DESCRIPTION
[0050] The preferred embodiments of the present invention will be described in detail below in conjunction with the accompanying drawings, wherein the accompanying drawings constitute a part of the present invention and are used together with the embodiments of the present invention to illustrate the principles of the present invention, but are not used to limit the scope of the present invention.
[0051] Example 1
[0052] In order to meet the needs of long pipe jacking operation time and high requirements on the deviation accuracy of the axis of the pipe jacking machine out of the hole, a specific embodiment of the present invention is as follows: Figure 1 As shown, a jacking pipe guiding and positioning device based on a combined navigation system is disclosed, including a host computer 1, an odometer 2, a fiber optic inertial navigation system 3, a first static level 5 and a second static level 6, and the odometer 2, the fiber optic inertial navigation system 3, the first static level 5 and the second static level 6 are all connected to the host computer 1.
[0053] The odometer 2 is arranged above the pipe segment 4 at the entrance of the working well, and the fiber optic inertial navigation 3 is arranged in the head of the jacking tunneling machine 8. The fiber optic inertial navigation 3 includes a fiber optic gyroscope and an accelerometer. The first static level 5 is located inside the head of the pipe jacking machine 8 as a measuring point, the second static level 6 is located outside the segment 4 as a reference point, the second static level 6 is installed on the wall of the shaft, the first static level 5 is installed inside the head of the pipe jacking machine 8, the compensation water tank 7 of the static level (the first static level 5 and the second static level 6) is located on the wall of the shaft, and its height is higher than the axis of the pipe jacking machine hole and the second static level 6, the compensation water tank 7 is connected to the air pipe above and the liquid pipe below, the air pipe and the liquid pipe are connected to the two levels (i.e., the second static level 6 and the first static level 5) in sequence, the first static level 5 and the second static level 6 are connected by a cable, and the second static level 6 is connected to the host computer 1 through a cable to realize power supply and data transmission. The segment 4 is connected to the pipe jacking machine 8.
[0054] In this embodiment, the compensation water tank 7 is a water supply device for the static level. The compensation water tank 7 has an air pipe above and a water pipe below, which are connected to the second static level 6 (reference point) and the first static level 5 (measuring point) in sequence. The second static level 6 measures the height difference of the second static level 6 relative to the liquid surface of the compensation water tank 7 through the pressure difference. Similarly, the first static level 5 will also measure a height difference relative to the compensation water tank 7. The difference between the latter height difference and the former height difference is the required elevation information (i.e., the height change of the measuring point relative to the reference point).
[0055] Let n be the inertial navigation calculation coordinate system (northeast celestial coordinate), and b be the carrier coordinate system.
[0056] The fiber optic gyroscope relies on a three-axis fiber optic gyroscope to measure angular velocity. The angular velocity of the earth's rotation is tracked by the three-axis fiber optic gyroscope, and the angular velocity signal of the earth's rotation is decomposed and solved to calculate the azimuth angle between the gyroscope's main axis and the earth's true north direction. The acceleration is measured using a three-axis accelerometer, and the azimuth and roll angles are calculated using the acceleration information sensed by the accelerometer to obtain the attitude of the tunnel boring machine (inclination angle θ, azimuth angle α, roll angle γ). The speed, position and other measurement parameters are then obtained through inertial navigation calculations.
[0057] The position of the odometer 2 is measured by installing the odometer 2 above the pipe segment 4 at the entrance of the working shaft, measuring the incremental distance of the pipe segment 4 pushed forward per unit time, and projecting and accumulating the position information on the navigation coordinate system.
[0058] The height measurement of the static level is through the hydraulic pressure change of the sensitive measuring point relative to the reference point, and then the height information is obtained based on the liquid density and gravity acceleration.
[0059] Example 2
[0060] A specific embodiment of the present invention discloses a positioning method of a pipe jacking guide device based on a combined navigation system according to Embodiment 1.
[0061] The Kalman filter state equation and observation equation of a continuous-time linear stochastic system can be expressed as
[0062]
[0063] Z(t)=H(t)X(t)+V(t) (2)
[0064] Where: X(t) is the state quantity, Z(t) is the quantity measurement, F(t) is the state transfer matrix, H(t) is the observation matrix, G(t) is the process noise transfer matrix, W(t) is the process noise, and V(t) is the observation noise.
[0065] Then, the state equation (1) and the measurement equation (2) are discretized to obtain:
[0066] X k =Φ k,k-1 X k-1 +Γ k-1 W k-1 (3)
[0067] Z k =H k X k +V k (4)
[0068] In the formula, X k is the n-dimensional state vector (estimated quantity) at time k, Z k is the m-dimensional measurement vector at time k, Φ k,k-1 is the system one-step state transfer matrix from time k-1 to time k (n×n order), H k is the system measurement matrix (m×n order) at time k, Γ k-1 is the system noise matrix (n×r order), W k-1 is the system noise at time k-1 (r dimension), V k is the m-dimensional measurement noise at time k.
[0069] The state prediction estimation equation is:
[0070]
[0071] In the formula, is k-1 time point X k-1 The estimated value of is the predicted value from time k-1 to time k.
[0072] The variance prediction equation is:
[0073]
[0074] Where P k-1 is the estimated covariance matrix. Q k-1 is the variance matrix of the system noise.
[0075] The state estimation equation is:
[0076]
[0077] Variance iteration equation:
[0078]
[0079] In the formula, K k is the filter gain, R k is the variance matrix of the measurement noise.
[0080] The filter gain equation is:
[0081]
[0082] The initial conditions are:
[0083]
[0084] The pre-test statistic is:
[0085] E[W k ]=0,Cov[W k ,W j ]=E[W k W j T ]=Q k δ kj
[0086] E[V k ]=0,Cov[V k ,V j ]=E[V k V j T ]=R k δ kj
[0087] Cov[W k ,V j ]=E[W k V j T ]=0
[0088]
[0089] like Figure 2 As shown, it can be seen that the Kalman filter contains two update loops and two filter loops: time update and measurement update, filter calculation loop and gain calculation loop. The basic equations of Kalman filtering: state one-step prediction equation, variance prediction equation, state estimation equation, estimated error variance equation and filter gain equation. The Kalman filter realizes prediction and correction update estimation through iterative operation.
[0090] Figure 2 middle, t k-1 The estimated value of the state at the moment; Yes Status Kalman filter estimation of Φ k,k-1 t k-1 Time to t k One-step transfer array at a time; Γ k-1 is the system noise driving array; H k is the measurement array; Rk is the measurement noise variance; Q k is the system noise variance matrix; K k is the filter gain; Z k Measurement value; P k-1 is the estimated mean square error matrix; P k,k-1 One-step forecast error variance matrix.
[0091] The steps of the positioning method include:
[0092] Step 1: Build the error model of the fiber optic gyroscope and accelerometer.
[0093] Gyro error model:
[0094]
[0095] The error model of gyro bias can be expressed by the first-order Markov process model equation:
[0096]
[0097]
[0098] In the above equation, are the ideal values of the x, y, and z axis gyroscopes, respectively; They are the zero bias of the gyroscope x, y, and z axes in the carrier coordinate system; are the x, y, and z axis gyro measurement values respectively; K gx , K gy , K gz are the gyro x, y, and z axis scale factors respectively; δK gx ,δK gy ,δK gz are the gyro x, y, and z axis scale factor errors respectively; M ij W is the misalignment angle of the gyroscope j axis toward i axis; εx , W εy , W εz are the random noises of the gyroscope x, y, and z axes respectively; 1 / β εx , 1 / β εy , 1 / β εz are the correlation times of the random processes along the x, y, and z axes of the gyroscope, respectively.
[0099] Accelerometer error model:
[0100]
[0101] The error model of the accelerometer zero bias can be expressed by the first-order Markov process model equation:
[0102]
[0103]
[0104] In the above equation, are the ideal values of the accelerometer x, y, and z axes respectively; They are the zero bias of the accelerometer x, y, and z axes in the carrier coordinate system; are the x-, y-, and z-axis measurement values of the accelerometer respectively; K Ax , K Ay , K Az are the x, y, and z axis scale factors of the accelerometer respectively; δK Ax ,δK Ay ,δK Az are the scale factor errors of the accelerometer in the x, y, and z axes respectively; A ij W is the misalignment angle of the accelerometer j axis toward the i axis; ▽x , W ▽y , W ▽z are the random noises of the accelerometer in the x, y, and z axes respectively; 1 / β ▽x , 1 / β ▽y , 1 / β ▽z are the correlation times of the random noise in the x, y, and z axes of the accelerometer, respectively.
[0105] Step 2: Establish error equations for velocity, position, and attitude parameters.
[0106] Velocity error equation:
[0107]
[0108] Where:
[0109]
[0110]
[0111] is the attitude transfer matrix; v E 、v N 、v U The velocities in the east, north and sky directions in the navigation calculation coordinate system are δv E ,δv N ,δv U They are the velocity errors in the east, north and celestial directions in the navigation calculation coordinate system respectively; are the inclination, roll and azimuth errors in the navigation calculation coordinate system respectively; L is the latitude of the FOINS location; δL is the latitude error of the FOINS location; h is the height of the FOINS location; ωie is the angular velocity of the Earth's rotation; are the zero bias of the accelerometer x, y, and z axes in the navigation calculation coordinate system; R M R is the principal radius of curvature of the Earth's meridian; N It is the principal radius of curvature of the Earth's ecliptic.
[0112] Position error equation:
[0113]
[0114] Where L, λ, h are the latitude, longitude and depth of the earth where the fiber-optic inertial navigation system is located; δL, δλ, δh are the latitude error, longitude error and altitude error.
[0115] Attitude error equation:
[0116]
[0117] Where:
[0118]
[0119] in is the error of the inclination angle, is the error of the rolling angle, is the azimuth error; is the Earth's rotation angular rate; is the displacement angular velocity; They are the zero bias of the gyroscope x, y, and z axes in the navigation coordinate system.
[0120] Step 3: Determine the state variables and state equations according to the error models of the gyroscope and accelerometer and the error equations of the velocity, position, and attitude parameters.
[0121] According to the Kalman filter state equation, the state equation of the pipe jacking guidance positioning algorithm can be expressed as, rewriting formula (1):
[0122]
[0123] Status quantity:
[0124] In pipe jacking projects, the gyroscopes used are medium- and low-precision fiber optic gyroscopes. It is believed that the error caused by the misalignment angle is much smaller than the error caused by the scale factor, so the error caused by the misalignment angle is not considered. A in the error model (12) ij (i=x,y,zj=x,y,z.) and M in the error model (12) ij (i=x,y,zj=x,y,z.) can be ignored.
[0125] According to the working characteristics of pipe jacking construction, the angular velocity of the pipe jacking around the x, y, and z axes is very small during the jacking process, so the scale factor error of the x, y, and z axes can be ignored, that is, δK gx ,δK gy ,δK gz The speed of pipe jacking construction is generally very slow, usually 10-20 mm / min, so the scale factor errors of the three accelerations can be ignored, that is, δK Ax ,δK Ax ,δK Az Both can be ignored.
[0126] Therefore, for the selection of devices for fiber optic gyroscopes As a state quantity.
[0127] According to the above speed error equation, position error equation, and attitude error equation, the three speed errors, attitude errors, and position errors are also determined as state quantities, and the final state quantity is determined as:
[0128]
[0129] Where: is the system attitude error, δv E ,δv N ,δv U is the system velocity error, δL, δλ, δh are the system position errors, They are the equivalent drift and zero position of the gyroscope and accelerometer along the three-axis directions of the carrier coordinate system, respectively.
[0130] W is the system noise, which can be determined as follows based on the error model of the gyroscope and accelerometer:
[0131]
[0132] G is the system noise transfer matrix, G = I 15×15 .
[0133] State transition matrix:
[0134] F is the state transfer matrix of the integrated navigation algorithm, which can be expressed as:
[0135]
[0136] where F N The system dynamic matrix corresponding to the 9 system error parameters of the fiber optic gyroscope and accelerometer is a 9×9 square matrix. N The non-zero elements of the array are as follows:
[0137]
[0138] f 2,7 =-ω ie sI
[0139]
[0140] f 4,2 =-f U ,f 4,3 =f U ,
[0141]
[0142] f 5,1 =f U ,f 5,3 =-f E ,
[0143]
[0144] f 6,1 =-f N ,f 6,2 =f E , f 6,7 =-2v E ω ie sI
[0145] f 9,6 =1
[0146] F s for:
[0147]
[0148] F noise for:
[0149]
[0150] Step 4: Establish measurement and measurement equations based on the zero speed information and zero angular velocity information measured when the pipe section is stationary during pipe jacking replacement, the position information measured by the odometer, the height information calculated by the static level, and the position information calculated by the fiber optic inertial navigation.
[0151] The measurement equation of Kalman filter is as shown in formula (2), which can be rewritten as follows:
[0152] Z(t)=H(t)X(t)+V(t) (30)
[0153] It is necessary to determine the measurement information Z, the measurement transfer matrix H, and the measurement noise V.
[0154] In actual measurement, since the speed of pipe jacking is very slow, the zero-speed state is first detected in the algorithm. The present invention uses a generalized likelihood ratio detection method of gyroscope and acceleration information to perform zero-speed detection.
[0155]
[0156] This equation is used to determine the zero speed state. If Stc = 1, zero speed correction and zero angular speed correction are introduced. If Stc = 0, corrections are made to other external information sources. w is the sliding detection window length, are the acceleration and angular velocity means in the window, T f , T ω To detect the threshold, if the variance at time k is less than the threshold, then time k is the zero speed moment, and the zero speed and zero angular velocity information are updated, otherwise it is a non-zero speed moment. The measurement information that can be observed at the zero speed moment includes zero speed information and zero angular velocity information; the measurement information observed at the non-zero speed moment is the position information provided by the odometer and the static level.
[0157] Zero speed information:
[0158] The process of pipe jacking construction is that after the pipe section is lowered, the jacking cylinder is used to push it forward. After it reaches the designated position, the jacking cylinder is retracted and a new pipe section is lowered. Between the completion of the jacking of one pipe section and the start of the jacking of the next pipe section, the pipe jacking machine and the pipe section that has been jacked are in a static state. Therefore, during this period, the speed of the three directions of the pipe jacking machine is 0, but because its height channel is unstable, the celestial speed V calculated by the inertial navigation solution is not considered. U The speed value obtained by inertial navigation is the speed error. The speed error in the horizontal direction is selected. As a quantity measurement:
[0159]
[0160] Zero angular velocity information:
[0161] The azimuth error in the zero-speed state is unobservable. Kalman filtering using only zero-speed information cannot accurately estimate the heading error. Theoretically, the true azimuth at adjacent moments in the zero-speed state is the same. Therefore, the heading angle difference at adjacent moments is used as the measurement value to reduce the azimuth error caused by gyro drift and improve the azimuth accuracy. The rotation angular velocity vector ω of the carrier coordinate system relative to the navigation coordinate system nb It can be expressed as:
[0162]
[0163] in, are the rotation angular rates of the carrier coordinate system rotating around the x, y, and z axes to the navigation coordinate system respectively. nb The projection on the three axes of the carrier coordinate system is expanded as follows:
[0164]
[0165] in, ω nb The projection on the three axes of the carrier coordinate system, θ, γ are the rotation angles of the carrier coordinate system around the x and y axes to the navigation coordinate system respectively. Inverse equation (34).
[0166]
[0167] In the formula, Substituting into equation (35) we can get the true azimuth angle change rate:
[0168]
[0169] In the formula, The angular velocity of the carrier system, The angular velocity of the navigation coordinate system, is the rotation angle of the carrier coordinate system around the z-axis to the navigation coordinate system. The azimuth angle change rate is calculated by formula (36):
[0170]
[0171] in, is the measured angular velocity of the carrier coordinate system, is the constant drift of the gyroscope. In the static state, the angular velocity of the navigation coordinate system is equal to the angular velocity of the earth's rotation. Therefore, subtracting equation (37) from equation (36) yields:
[0172]
[0173] in, is the angular velocity of the earth's rotation in the navigation coordinate system, ω ie is the angular velocity of the earth's rotation, L is the latitude at the current moment, is the azimuth angle change rate error, is the azimuth error. The azimuth difference at adjacent moments is:
[0174]
[0175] in, are the azimuths of the current moment and the previous moment respectively, and ΔT is the navigation solution period. As a quantity measurement.
[0176] Location Information:
[0177] The position information is calculated by the distance information measured by the odometer. The calculation principle is to calculate the current position of the carrier through the change of the carrier's attitude, combined with the carrier's distance increment and the position and attitude information at the initial time. The calculation principle of dead reckoning on a two-dimensional plane is as follows Figure 3 shown.
[0178] Among them, P0 (x0, y0) is the initial point, and the coordinates of points P1 (x1, y1) and P2 (x2, y2) can be calculated through the distance increment and heading angle;
[0179]
[0180] Among them, ΔS1, They are the distance increment and azimuth between points P1 and P0 respectively. Based on point P1, the position coordinates of point P2 can be deduced:
[0181]
[0182] Among them, ΔS2, are the distance increment and azimuth between points P2 and P1 respectively, so the position solution equation of dead reckoning can be expressed as:
[0183]
[0184] Suppose the eastward displacement increment ΔS between the two points before and after the pipe top position is updated E , northward displacement increment ΔS N , the calculation formulas are as follows:
[0185]
[0186] Where ΔS is the distance increment between two points, θ and are the inclination and azimuth of the previous moment respectively. Then the latitude and longitude information obtained by calculating the updated position information can be obtained through the following formula.
[0187]
[0188] Among them, L0, λ0 and h0 are the latitude, longitude and altitude information at the entrance of the working well.
[0189] The altitude information in the position information is provided by the static level. The elevation information of the current position can be obtained through the hydraulic pressure difference between the measuring point and the reference point, the liquid density and the local gravity acceleration.
[0190]
[0191] Among them, hM is the height difference between the measuring point and the reference point, that is, the height information in the current position information, p m and p r is the liquid pressure at the measuring point in the pipe section and the reference point in the working well, ρ is the liquid density, and g is the local gravitational acceleration.
[0192] Measurements and measurement equations:
[0193] For the specific situation of pipe jacking construction, the following external observation information can be used:
[0194] (1) When the pipe is stationary during pipe jacking and pipe section replacement, the zero speed information is obtained through zero speed detection. and zero angular velocity information
[0195] (2) Horizontal position information obtained by dead reckoning based on the odometer: latitude L D and longitude λ D ; and the height information h obtained based on the hydraulic pressure difference between the reference point and the measuring point of the static level M .
[0196] Therefore, the measured values are zero speed information, zero angular speed information, and the difference between the position information calculated by the odometer and static level and the position calculated by the fiber optic inertial navigation system, and the measurement equation of the jacking guide positioning method is obtained.
[0197]
[0198] Among them, Z k is the quantity measurement, X is the state quantity, υ is the measurement noise, and the measurement matrix H k for
[0199]
[0200] in,
[0201] Step 5: Discretize the continuous-time system in the Kalman filter equation.
[0202] According to the linear system theory, the continuous-time linear random system is discretized into
[0203]
[0204]
[0205] Where M1=Q(t),M i+1 =FM i +M i T F T .
[0206] Step 6: Solve the Kalman filter equation, compensate the gyro and accelerometer output data according to the solution results, and obtain attitude and position information.
[0207] According to the zero speed, zero angular velocity and position observation information, Kalman filter information fusion solution is performed, and the optimal or suboptimal estimation of the navigation parameters is obtained through state estimation, and the inertial navigation is corrected by closed-loop feedback.
[0208] Compensation for accelerometer data:
[0209]
[0210] Compensation for gyro data:
[0211]
[0212] The velocity error, azimuth error, and position error estimated by Kalman filtering are used to timely correct the attitude, velocity, and position obtained by inertial navigation to obtain high-precision attitude and position information. The axis deviation of the jacking guide can be obtained by subtracting the position information from the preset trajectory. The algorithm flow chart is shown below: Figure 4 shown.
[0213] This method can provide a new method for positioning and orientation in pipe jacking construction. It solves the problem that the laser target positioning method is not suitable for curved pipe jacking and long-distance pipe jacking, and solves the problem that theodolite and total station are complicated and costly to operate and cannot be used in small-diameter pipe jacking. This method can provide high-precision positioning information for pipe jacking projects such as small-diameter pipe jacking, long-distance pipe jacking, and curved pipe jacking, laying the foundation for the automation and intelligence of pipe jacking construction.
[0214] The present invention designs a pipe jacking guide and positioning device composed of a fiber optic gyroscope, an odometer and a static level. The device has the advantages of small size and light weight, and is suitable for installation in small-diameter pipe jacking with strict space and weight requirements. The sensors provide characteristic information of pipe jacking construction, including distance information of the odometer, zero speed and zero angular velocity information of the pipe section of the pipe jacking replacement, and height information of the static level. A combined guidance method based on the fusion of multiple sensor data of the fiber optic gyroscope / odometer / static level is proposed, that is, the fiber optic gyroscope is used as the main sensing element, the distance information of the odometer and the height information of the static level assist the fiber optic gyroscope, the error propagation mechanism of the fiber optic gyroscope, the distance of the odometer and the height of the static level is studied, an error model is established, and the Kalman filter method is used for information fusion. The optimal estimation of the pipe jacking posture and axis deviation parameters is obtained through state estimation. The navigation task is completely completed by airborne equipment, and high-precision and high-reliability guidance information can be provided for the pipe jacking project without any external electromagnetic signal. The invention can be applicable to pipe jacking projects with small diameter, large elevation, long distance and large curvature.
[0215] The above description is only a preferred specific implementation manner of the present invention, but the protection scope of the present invention is not limited thereto. Any changes or substitutions that can be easily conceived by any technician familiar with the technical field within the technical scope disclosed by the present invention should be covered within the protection scope of the present invention.
Claims
1. A positioning method for a pipe jacking guide positioning device based on an integrated navigation system, characterized in that: The jacking pipe guiding and positioning device comprises a host computer (1), a compensation water tank (7), and an odometer (2), a fiber optic inertial navigation system (3), and a static level connected to the host computer (1); the static level comprises a first static level (5) and a second static level (6); the odometer (2) is arranged above the pipe segment (4) at the entrance of the working well; the fiber optic inertial navigation system (3) is arranged in the head of the jacking pipe boring machine (8); the first static level (5) is located in the head of the jacking pipe boring machine (8) as a measuring point; the second static level (6) is located outside the pipe segment (4) as a reference point; the first static level (5), the second static level (6), and the compensation water tank (7) are connected through an air pipe and a liquid pipe; The positioning method comprises the following steps: Step 1: Establish the error model of FOG gyroscope and accelerometer; Step 2: Establish error equations for velocity, position, and attitude parameters; Step 3: Determine the state variables and state equations according to the error models of the gyroscope and accelerometer and the error equations of the velocity, position, and attitude parameters; Step 4: When the pipe is stationary during pipe replacement, the zero speed information is obtained through zero speed detection and zero angular velocity information in, is the velocity error in the horizontal direction, are the azimuths of the current moment and the previous moment respectively; According to the horizontal position information obtained by the odometer based on dead reckoning: latitude L D and longitude λ D ; and the height information h obtained based on the hydraulic pressure difference between the reference point and the measuring point of the static level M ; The measurement is the zero speed information, zero angular speed information and the difference between the position information solved by the odometer and the static level and the position solved by the fiber optic inertial navigation, and the measurement equation is obtained; Step 5: Discretize the continuous-time system in the Kalman filter equation; Step 6: Solve the Kalman filter equation, compensate the gyro and accelerometer output data according to the solution results, and obtain attitude and position information.
2. The positioning method of the pipe jacking guide positioning device based on the integrated navigation system according to claim 1, characterized in that: The odometer (2) measures the distance increment of the pipe segment (4) pushed forward per unit time, and projects and accumulates the distance increment on the navigation coordinate system to obtain position information.
3. The positioning method of the pipe jacking guide positioning device based on the integrated navigation system according to claim 1, characterized in that: The height information of the static level is obtained by changing the hydraulic pressure of the first static level (5) relative to the second static level (6) and then according to the liquid density and gravity acceleration.
4. The positioning method of the pipe jacking guide positioning device based on the integrated navigation system according to claim 1, characterized in that: In step 1, the gyro error model is: in, are the ideal values of the x, y, and z axis gyros, respectively; They are the zero bias of the gyroscope x, y, and z axes in the carrier coordinate system; are the x, y, and z axis gyro measurement values respectively; K gx , K gy , K gz are the gyro x, y, and z axis scale factors respectively; δK gx ,δK gy ,δK gz are the scale factor errors of the gyroscope x, y, and z axes respectively; M ij is the misalignment angle of the gyroscope j-axis toward the i-axis.
5. The positioning method of the pipe jacking guide positioning device based on the integrated navigation system according to claim 4 is characterized in that: In step 1, the accelerometer error model is: in, are the ideal values of the accelerometer x, y, and z axes respectively; They are the zero bias of the accelerometer x, y, and z axes in the carrier coordinate system; are the x-, y-, and z-axis measurement values of the accelerometer respectively; K Ax , K Ay , K Az are the x, y, and z axis scale factors of the accelerometer respectively; δK Ax ,δK Ay ,δK Az are the scale factor errors of the accelerometer in the x, y, and z axes respectively; A ij is the misalignment angle of the accelerometer j axis toward the i axis.
6. The positioning method of the pipe jacking guide positioning device based on the integrated navigation system according to claim 5, characterized in that: In step 2, the speed error equation is: Among them, v E 、v N 、v U The velocities in the east, north and sky directions in the navigation calculation coordinate system are δv E ,δv N ,δv U They are the velocity errors in the east, north and celestial directions in the navigation calculation coordinate system respectively; are the inclination, roll and azimuth errors in the navigation calculation coordinate system respectively; L is the latitude of the FOINS location; δL is the latitude error of the FOINS location; h is the height of the FOINS location; ω ie is the angular velocity of the Earth's rotation; are the zero bias of the accelerometer x, y, and z axes in the navigation calculation coordinate system; R M R is the principal radius of curvature of the Earth's meridian; N It is the principal radius of curvature of the Earth's ecliptic.
7. The positioning method of the pipe jacking guide positioning device based on the integrated navigation system according to claim 6, characterized in that: In step 2, the position error equation is: Wherein, L, λ, h are the latitude, longitude and depth of the earth where the fiber-optic inertial navigation system is located; δL, δλ, δh are the latitude error, longitude error and altitude error.
8. The positioning method of the pipe jacking guide positioning device based on the integrated navigation system according to claim 7, characterized in that: In step 2, the attitude error equation is: in, is the error of the inclination angle, is the error of the rolling angle, is the azimuth error; is the Earth's rotation angular rate; is the displacement angular velocity; They are the zero bias of the gyroscope x, y, and z axes in the navigation coordinate system.
9. The positioning method of the pipe jacking guide positioning device based on the integrated navigation system according to claim 8, characterized in that: In step 6, the accelerometer output data is compensated: Compensate the gyro output data:
