Next Article in Journal
Attempts to Obtain Material Based on Polyvinyl Alcohol with Barrier Properties against Water Vapor
Next Article in Special Issue
Additional Taxi-Out Time Prediction for Flights at Busy Airports by Fusing Flow Control Information
Previous Article in Journal
Ultrasound Elastography: Methods, Clinical Applications, and Limitations: A Review Article
Previous Article in Special Issue
Hidden Markov Model-Based Dynamic Hard Shoulders Running Strategy in Hybrid Network Environments
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

Study of Tunnel Vehicle GNSS/INS/OD Combination Position Based on Lateral Distance Measurement and Lane Line Constraint

1
School of Transportation, Southeast University, Nanjing 210018, China
2
Bartlett School of Architecture, University College London, London WC1E 6BT, UK
*
Author to whom correspondence should be addressed.
Appl. Sci. 2024, 14(10), 4309; https://doi.org/10.3390/app14104309
Submission received: 31 March 2024 / Revised: 5 May 2024 / Accepted: 10 May 2024 / Published: 19 May 2024

Abstract

:
The high-precision dynamic positioning of highway vehicles is the foundation and prerequisite for achieving intelligent connected transportation. To address the shortcomings of the GNSS/INS combination and GNSS/INS/OD combination in tunnel vehicle positioning, this paper proposes a tunnel vehicle positioning method for the GNSS/INS/OD combination based on lateral distance measurements and lane constraints. Firstly, a lateral distance measurement of vehicles inside the tunnel is conducted based on laser radar point cloud data. Secondly, map matching positioning is performed based on lateral distance measurements, odometer, and lane markings. Experimental results demonstrate that, for a 4.6 km tunnel, the average absolute error in the lateral positioning is 0.294 m, and the longitudinal positioning error is no more than 0.6 m, which can effectively meet practical operational requirements.

1. Introduction

Currently, many countries are vigorously developing intelligent, connected, vehicle–road cooperative technologies [1]. Intelligent connected vehicles have become a strategic direction for the development of the global automotive industry [2]. The high-precision dynamic positioning of highway vehicles serves as the foundation and a prerequisite for achieving intelligent connected transportation [3]. A high-precision spatio-temporal reference service is listed as the key basic technology that needs to be established [4], and the high-precision intelligent navigation of unmanned vehicles under the condition that satellites are not available is listed as one of the ten major engineering and technical problems [5].
There are two main methods for vehicle mobile positioning: satellite navigation and inertial navigation [6]. As long as a Global Navigation Satellite System (GNSS) can receive the navigation satellite signal, it can calculate the position and speed of the vehicle [7]. An Inertial Navigation System (INS) works based on the inertial principle and does not need any external information when working, but navigation errors accumulate over time [8].
In general road environments, a GNSS can be applied to achieve vehicle positioning [9]. In short-range shielded environments, vehicles can maintain a good continuous positioning performance based on a combination of a GNSS and INS [10,11,12]. However, in strongly shielded environments, such as long tunnels, effectively suppressing the divergence speed of the INS is an important issue that urgently needs to be addressed [13,14]. When GNSS signals are unavailable because of obstruction, multipath effects, etc., the GNSS/INS/odometer (OD) combination can effectively mitigate the accumulation of INS errors to a certain extent, achieving the high-precision stable navigation and positioning of the vehicle [15,16].
To simulate the positioning performance of tunnel vehicles using a GNSS/INS/OD combination, the authors conducted experiments on a certain section of the highway where all GNSS signals were artificially removed. Only inertial navigation and the odometer were used for dead reckoning, and the GNSS/INS data fusion results were used as the reference trajectory (truth value) for comparison. The experimental results indicate that as the dead reckoning distance increases, the positioning results deviate more and more from the true trajectory. At a distance of 545 m, the positioning error is approximately 0.88 m [17]. This cannot meet the practical requirements for tunnel vehicle positioning.
The reason for this lies in the fact that, during vehicle motion, the output of inertial devices contains significant noise. How to distinguish between valid data and noise and reduce the impact of vibration noise on system stability and positioning accuracy remains to be studied [18,19,20]. In different scenarios, when the effectiveness of sensors in the integrated navigation system changes, corresponding adjustments need to be made to the state space model [21,22]. Multi-sensor systems are often heterogeneous due to their different principles, making it a challenge to construct reliable multi-sensor fusion function models that can accommodate the real-time addition and removal of sensor types [23,24].
Based on this, this paper uses high-precision digital lane maps, as well as the advantages of LiDAR in distance measurement and odometry in mileage counting, to propose a combined GNSS/INS/OD positioning method for tunnel vehicles based on lateral distance measurement and lane line constraints. It mainly consists of two steps: (1) the lateral distance measurement of vehicles inside a tunnel based on laser radar point cloud data; (2) map matching combined positioning based on lateral distance measurements, odometer, and lane markings. The prerequisite for this positioning method is that a high-precision electronic map of the tunnel has previously been measured or obtained.

2. Research on Lateral Distance Measurements for Tunnel Vehicle Localization

The principle of a laser radar, also known as Light Detection and Ranging (LiDAR), is based on its emitting an infrared laser beam from the radar itself and receiving the reflected infrared beam from the surrounding environment. By measuring the time between the emission and reception of the laser pulses, the distance can be calculated. Taking the example of a VLP-16 LiDAR (Figure 1), this consists of 16 laser beams distributed within a 30° angle. The beams are evenly spaced at a 2° interval, with 15° covering the upward and downward directions.
Using LiDAR to obtain lateral distance measurements of tunnel vehicles, the specific method is as follows:
(1)
Classify LiDAR points into surface feature points and line feature points based on curvature, and remove the line feature points.
By applying the LiDAR-measured point cloud data of the tunnel, calculate the curvature of each point using the following formula:
c = 1 S · X k , i L j ϵ S , j i X k , j L X k , i L
In the equation, S represents the set of five continuous points obtained by the same laser beam; X k , j L and X k , i L represent the coordinates of the j-th and i-th points in the k-th frame in the LiDAR coordinate system. Typically, the points with the highest curvature are selected as line feature points, while those with the lowest curvature are considered surface feature points.
(2)
Calculate the horizontal distance from the LiDAR to obstacles when LiDAR is horizontal and select the m smallest values. These values correspond to the point cloud data that form a set { D } .
Assuming the maximum elevation angle of the LiDAR is θ , select the point cloud data with an elevation angle of θ obtained from step (1). Calculate the horizontal distance between the LiDAR and obstacles at different horizontal rotation angles when the elevation angle is θ , using the following formula:
d γ = l θ · cos θ
{ D } m ,   d D γ = min d γ
In the equation, γ represents the horizontal rotation angle of the LiDAR, d γ represents the horizontal distance between the LiDAR and obstacles at an elevation angle of θ and a horizontal rotation angle of γ , and l θ represents the slope distance between the LiDAR and obstacles at an elevation angle of θ and a horizontal rotation angle of γ . { D } represents the set of point cloud data from the m LiDARs with the smallest d γ , and m represents the length of { D } . Refer to Figure 2 for illustration.
(3)
Calculate the horizontal distance from the LiDAR to obstacles when it is tilted.
Uneven road surfaces or the tilting of the LiDAR may cause it to be non-horizontal, as shown in Figure 3.
Select the point cloud data obtained from the LiDAR with an elevation angle of α ( α < θ ) from step (1). For each LiDAR point in { D } described in step (2), select the point cloud data with the same horizontal rotation angle and an elevation angle of α , then calculate the horizontal distance d l between the LiDAR and obstacles at that horizontal rotation angle. The calculation formula is as follows:
a = l θ 2 + l α 2 2 l θ l α cos θ α
d l = l θ · 1 a 2 + l θ 2 l α 2 2 a l θ 2
In the equation, α represents the elevation angle of the LiDAR, where α < θ . a represents the distance between a LiDAR point with an elevation angle of θ and a horizontal rotation angle of γ and another LiDAR point with an elevation angle of α and a horizontal rotation angle of γ . l α represents the slope distance between the LiDAR and obstacles measured at an elevation angle of α and a horizontal rotation angle of γ . d l represents the horizontal distance between the LiDAR and obstacles measured at a horizontal rotation angle γ .
(4)
Calculate the precise horizontal distance between the LiDAR and obstacles.
Based on parameter d l described in step (3), use the following formula:
d = min d l
In the equation, d represents the precise distance value between the LiDAR and obstacles, where is the minimum value among d l .
(5)
Calculate the distance from the LiDAR to the other side of the obstacles.
Select the distances l θ 1 measured between the LiDAR and obstacles at an elevation angle of θ and a horizontal rotation angle of φ + π from step (1), as well as the distances l α 1 measured at an elevation angle of α ( α < θ ) and a horizontal rotation angle of φ + π . Calculate the distance between the LiDAR and obstacles on the other side using the following formula:
a = l θ 1 2 + l α 1 2 2 l θ 1 l α 1 cos θ α
d l = l θ 1 · 1 a 2 + l θ 1 2 l α 1 2 2 a l θ 1 2
In the equation, a represents the distance between the LiDAR point with an elevation angle of θ and a horizontal rotation angle of φ + π and the LiDAR point with an elevation angle of α and a horizontal rotation angle of φ + π , and d l represents the horizontal distance between the LiDAR and obstacles measured at a horizontal rotation angle φ + π .
(6)
Correction of lateral distance.
In tunnels, emergency stopping zones are provided at regular intervals. Additionally, there are situations where large and high vehicles run parallel to the test vehicle. As shown in Figure 4, under these two special circumstances, the calculated lateral distance values are wrong and require correction. Let d l and d r represent the horizontal distances from the onboard LiDAR to the left and right obstacles, respectively, and d b represents the typical width of a tunnel segment. In normal conditions, horizontal distances of the previous time p from the LiDAR to the left and right obstacles are represented by d l p and d r p , respectively. Considering that the width of the typical tunnel segment remains unchanged, the correction method for the lateral distance is as follows:
d l = d l , d r = d r               d l + d r = d b d l = d l , d r = d b d l       d l + d r d b ,   d l = d l p , d r d r p d r = d r , d l = d b d r     d l + d r d b , d r = d r p ,   d l d l p delete                                 d l + d r d b ,   d l d l p , d r d r p
In the equation, within the judgment condition, an error threshold δ can be added, for example, by setting δ = 5 ~ 10   c m .

3. Combined Positioning of Tunnel Vehicles Constrained by Lane Lines and Lateral Distance

(1)
Determine the starting point of the mileage constraint. Before entering the tunnel, according to the GNSS Real-Time Kinematic (RTK) positioning results of the satellite, the corresponding lane line points are geometrically matched in the vertical direction and are recorded as the starting point of the mileage constraint.
(2)
Calculate accumulated vehicle mileage. According to the wheel speedometer, the cumulative calculation of vehicle mileage is accumulated by the encoder pulse count of the cumulative mileage meter. Assuming that the cumulative number of pulses of the odometer at a certain time is n, the total cumulative mileage at this time is as follows:
S = n × l × ( 1 + γ )
where l denotes the circumference of the wheel (prior value, unit: m), and γ represents the perimeter error coefficient in the process of vehicle travel, which is estimated via real-time joint solution calculation with GNSS RTK/INS.
(3)
Calculate the distance between the vehicle and the lane line. In the tunnel, assuming that the distance between the lane line and the tunnel wall remains unchanged (there will be a small change in reality), this is Δ d , as shown in Figure 5. The distance between the vehicle and the lane line can be obtained as follows:
d ~ = d Δ d
(4)
Determine the matching points. As shown in Figure 5, the method of matching the corresponding points of lane lines according to the total mileage S is as follows:
p 1 = S / b + p 0 p 2 = S / b + p 0 + 1
where p 1 indicates the previous recent spot number of the match and p 2 indicates the nearest point of the latter match; b indicates the distance between lane line points (the value in this paper is fixed at 1 m) and p 0 indicates the start dot number.
(5)
Calculate the coordinates of vertical points. According to the principle of distance division, the coordinates of vertical point p v can be obtained as follows:
x p v = x p 1 + β ( x p 2 x p 1 ) y p v = y p 1 + β ( y p 2 y p 1 )
where β = S f l o o r ( S ) , f l o o r ( ) indicates the hole down.
(6)
According to the lateral distance of the vehicle from the lane line and the azimuth of the point tangent line, the coordinates of the vehicle point v ( x v , y v ) are obtained, as shown in Figure 6 and Formula (14).
x v = x p v d ~ sin ( 360 α ) y v = y p v d ~ cos ( 360 α )
According to the above mileage matching and lane line constraint positioning method, a higher lateral positioning accuracy can be obtained. However, in the longitudinal direction, due to odometer calibration errors, it is easy to produce mileage accumulation errors when driving for a long time, so in long-distance applications, it is necessary to fully consider the impact of odometer calibration errors. Therefore, this paper proposes a potential positioning for further location combinations of mileage matching positioning results and INS/OD. In other words, the above positioning results are further integrated with the INS/OD combination, and the mileage matching positioning results are used to correct and feedback the INS zero bias errors and odometer scale errors. The odometer calibration error feedback calculated by the INS/OD combination corrects the matching positions of the odometer and lane line, and realizes the mutual correction and complementary advantages of sensors and different positioning means.

4. Case Study of Lateral Distance Measurement

4.1. Static Testing

During the static test, the situation in the tunnel is simulated, the experimental environment is set in the corridor, the LiDAR is placed on the horizontal ground, the algorithm result value is measured by LiDAR, and the results are measured by steel tape. The experimental results of multiple measurements are shown in Table 1. As can be seen from the table, in these measurements, the results of the algorithm have centimeter-level accuracy, the fluctuation range is within 1 cm, and lateral positioning results with centimeter-level accuracy in the tunnel can be obtained.

4.2. Dynamic Test

In a tunnel section, a vehicle lateral location measurement experiment was carried out, and the dynamics and practicability of the algorithm were verified by the actual data. The vehicle drove in the left lane, and the test found that the distance of the vehicle from the left wall was about 5.74 m, the distance from the right wall was about 6.21 m, and the total width of the tunnel was about 11.96 m. According to experience, the design width of the tunnel is about 12 m, so the accuracy of the distance measured from the LiDAR to the walls on both sides of the tunnel meets the requirements. The distance between the vehicle and the walls on both sides cannot remain unchanged during the process of driving, so the distance between the vehicle and the walls on both sides fluctuates within a certain range. At the same time, the measured tunnel width is relatively stable, and the fluctuations are also in the centimeter-level range.

5. Case Study of Combined Positioning in Tunnels

The positioning performance in a real tunnel environment was verified by field tests in the Yudushan Tunnel in Beijing. The tunnel has a total length of 9.2 km, with open sections at the entrances and exits that can receive GNSS signals; however, the interior of the tunnel is a closed environment where GNSS data cannot be received. Vehicles travel at a speed of approximately 60 km/h inside the tunnel. The sensors used for the tests include GNSS RTK, INS, odometer, a laser radar for lateral distance measurements inside the tunnel, and lane map data. GNSS RTK differential data were gotten according to the virtual reference station data provided by Qianxun Location FindCM service.
The tests involved driving from Beijing towards Zhangjiakou (designated as the forward direction), then returning in the opposite direction, making a total of two round trips with four passages through the tunnel. Three methods were used in each test: ① GNSS/INS combination; ② GNSS/INS/OD combination; ③ GNSS/INS/OD combination with lateral distance measurement and lane constraints.

5.1. Comparison of Three Positioning Methods

Figure 7 shows the positioning trajectories of three positioning methods in the tunnel. The green points represent the GNSS/INS combined positioning results, the yellow points represent the GNSS/INS/OD combined positioning results, the red points represent the GNSS/INS/OD combined positioning results constrained by lateral distance and lane lines, and the blue points represent the actual lane lines. From the figure, it can be seen that the GNSS/INS combination deviates the most from the lane lines, with the largest positioning error. The GNSS/INS/OD combination follows; although it shows significant improvements compared to the GNSS/INS combination, the positioning deviation is still considerable over long distances. The GNSS/INS/OD combination with lateral distance lane line constraints provides the best positioning results.
Due to the moving status of vehicles in the tunnel and the lack of means for high-precision dynamic positioning assessment on the roadside, it is difficult to quantitatively evaluate the absolute positioning accuracy in the tunnel. Therefore, in this study, in the open area outside the tunnel, the positioning data were compared with the RTK positioning results obtained at the same time as the first fixed solution to calculate the positioning accuracy when the vehicle exits the tunnel. Figure 8, Figure 9 and Figure 10 show the first positioning results outside the tunnel in the opposite direction. The yellow points represent the first fixed RTK results outside the tunnel, which serve as a reference due to the centimeter-level accuracy of RTK’s fixed solutions; the red points represent the positioning points that are extended from the tunnel positioning method (excluding the GNSS signals received when exiting the tunnel). The distances between corresponding points (at the same time) in the figures represent the errors between the tunnel positioning points and the RTK reference points. Table 2 provides the corresponding error statistics for two tunnel driving scenarios. It can be seen from the table that in the two sets of experiments, the positioning errors of GNSS/INS and GNSS/INS/OD combinations at the RTK fixed points outside the tunnel are over 100 m, indicating that relying solely on INS, odometers, and other dead reckoning sensors in severe GNSS-denied environments in long tunnels makes it difficult to maintain high-precision positioning and navigation capabilities. The GNSS/INS/OD combination with lateral distance and lane markings constraints provides positioning results that are closest to the RTK results, with a horizontal positioning accuracy between 1.2 m and 1.5 m.

5.2. Analysis of Lateral Positioning Error

In order to quantitatively analyze the lateral accuracy of GNSS/INS/OD combined positioning constrained by lane lines inside the tunnel, the experimental results in the opposite direction are analyzed and statistically processed below. In this experiment, the vehicle’s driving speed inside the tunnel was approximately 60 km/h, as shown in Figure 11. Figure 12 provides the lateral error of a 9.2 km tunnel, with the elliptical marked portion representing a 4.6 km half-length tunnel. The method used to calculate lateral error is as follows: at each comparison moment, calculate the vertical distance between the positioning point and the lane line, then subtract the actual distance of the vehicle from the lane line at the corresponding moment (this distance is obtained by subtracting the lane line distance from the tunnel wall distance measured by LiDAR).
As can be seen from Figure 12, with the increase in driving distance in the tunnel, the positioning error shows a gradually diverging trend. In the second half of the tunnel, the positioning error diverges severely, reaching a maximum of 1 m. The positioning error results for the 4.6 km midpoint of the tunnel are summarized in Table 3. The table includes the arithmetic mean, absolute error mean, root mean square error, maximum error, minimum error, and the 95th percentile of the absolute error. In Table 3, a total of 61,001 positioning points were analyzed. It can be observed that the arithmetic mean of the lateral error is 0.013 m, and the absolute error mean is 0.294 m, which characterizes the absolute lateral accuracy of vehicle positioning. The maximum error and minimum error are 0.671 m and −0.865 m, respectively, with the 95th percentile of the absolute error being 0.612 m, indicating that further improvement is needed in the stability of vehicle positioning in the tunnel.

5.3. Analysis of Longitudinal Positioning Errors

For the longitudinal positioning errors inside the tunnel, due to the lack of reference points for dynamic positioning evaluation within the tunnel, the longitudinal accuracy at the 9.2 km tunnel entrance based on RTK positioning results is used to infer the longitudinal accuracy over the 4.6 km tunnel length. Similarly, an analysis was conducted using the experimental results in the reverse direction. When the vehicle first obtains a fixed RTK solution upon exiting the tunnel, a comparison between the positioning points extended via the tunnel’s positioning method and the RTK positioning points is shown in Figure 10. At this point, the total horizontal positioning error is 1.43 m, and after subtracting the lateral positioning error of that point (0.86 m), the longitudinal positioning error is calculated to be 1.14 m. Based on the divergence characteristics of INS based on navigation estimation sensors and the cumulative nature of odometer errors with distance, it is known that the positioning error diverges faster with increasing driving distance, and the divergence speed in the latter half of the journey is significantly faster than that in the first half, as indicated in Figure 12, which also shows a similar phenomenon in the lateral positioning results. Therefore, it can be conservatively estimated that the longitudinal positioning error at the 4.6 km mark of the tunnel is no greater than 0.6 m. It should be noted that this longitudinal error is only an inferred value based on the results at the tunnel exit, representing a general accuracy level. The positioning errors at different positions within the tunnel may still fluctuate due to various measurement errors, as illustrated in Figure 12.

6. Conclusions

Building upon the GNSS/INS/OD combination positioning, this paper proposes a lane-constrained positioning method integrating odometer mileage calculation and laser radar lateral distance measurements. The constrained positioning results are used to update the measurements, achieving fusion between lane-constrained positioning within the tunnel and INS/OD combination positioning. First, the paper introduces a lateral distance measurement method inside tunnels based on laser radar. By constraining and extracting point clouds, the closest distances from the laser radar to the walls on both sides of the tunnel are calculated. Based on the horizontal rotation angle of these points, the left and right attributes of the walls are further determined. Additionally, by assuming a constant total width of the tunnel, the effects of interference from dynamic vehicles, emergency parking spaces, emergency exits, and other structural change scenarios on lateral distance measurements are resolved, enabling continuous lateral distance measurements. Furthermore, the positioning points calculated from odometer mileage and lateral distance are fused with the INS/OD combination positioning. On the one hand, this approach replaces GNSS measurement updates with positioning measurement points, effectively suppressing the divergence of the INS/OD errors. Simultaneously, the real-time calibration errors estimated by the odometer are fed back into the odometer mileage calculation, enhancing the accuracy of lane-constrained positioning. Through the fusion of these two positioning models, errors between different positioning models are mutually compensated and suppressed, thereby enhancing the accuracy and robustness of tunnel positioning.
The vehicle test results conducted at speeds of around 60 km/h inside tunnels demonstrate that the lane-constrained GNSS/INS/OD combination positioning model significantly improves the positioning accuracy of vehicles in long tunnels compared to the GNSS/INS combination and GNSS/INS/OD combination alone. Through a statistical analysis of 61,001 positioning points collected along a 4.6 km tunnel, the average absolute error of lateral positioning was found to be 0.294 m. In terms of longitudinal accuracy, compared with the precision at the tunnel exit (approximately 9.2 km) and the RTK fixed solution, the calculated longitudinal error at the midpoint of the 4.6 km tunnel is less than 0.6 m.

Author Contributions

Formal analysis, H.Z.V.; methodology, H.Z.; writing—original draft, H.Z. writing—review and editing, X.Z. All authors have read and agreed to the published version of the manuscript.

Funding

This research received no external funding.

Institutional Review Board Statement

Not applicable.

Informed Consent Statement

Not applicable.

Data Availability Statement

Data are contained within the article.

Acknowledgments

The authors acknowledge the tunnel administration for providing the test environment.

Conflicts of Interest

The authors declare no conflict of interest.

References

  1. U.S. Department of Transportation. ITS Strategic Plan 2020-2025[EB/OL]. 2020-05-06[2021-04-10]. Available online: https://www.its.dot.gov/stratplan2020 (accessed on 1 March 2024).
  2. U.S. Department of Transportation. Ensuring American Leadership in Automated Vehicle Technologies: Automated Vehicles 4.0[EB/OL]. 2020-01-08 [2021-04-10]. Available online: https://www.transportation.gov/av/4 (accessed on 1 March 2024).
  3. Cui, X.Q.; Zhang, X.G.; Chen, H.F. A comparative study on the policy management system of intelligent connected vehicles in China, America and Japan. China Auto 2020, 12, 55–60. [Google Scholar]
  4. Ministry of Science and Technology of the People’s Republic of China. Intelligent Vehicle Innovation and Development Strategy; Ministry of Science and Technology of the People’s Republic of China: Beijing, China, 2020; pp. 8–9.
  5. China Association for Science and Technology. Major Scientific and Engineering Problems in 2020; China Association for Science and Technology: Beijing, China, 2020; p. 2. [Google Scholar]
  6. Zhang, H.; Xiong, H.; Hao, S.; Yang, G.; Wang, M.; Chen, Q. A Novel Multidimensional Hybrid Position Compensation Method for INS/GPS Integrated Navigation Systems During GPS Outages. IEEE Sens. J. 2024, 24, 962–974. [Google Scholar] [CrossRef]
  7. Zhang, T.; Shi, J.; Lin, T.; Feng, X.; Niu, X. GNSS position-aided delay-locked loops for accurate urban navigation. GPS Solut. J. Glob. Navig. Satell. Syst. 2022, 27, 282–291. [Google Scholar] [CrossRef]
  8. Seo, Y.-B.; Yu, H.; Yu, M.-J. Calibration Method for INS Based on Multiple Actuator Function. Int. J. Control. Autom. Syst. 2021, 21, 244–256. [Google Scholar] [CrossRef]
  9. Jiang, C.; Chen, S.; Chen, Y.; Shen, J.; Liu, D.; Bo, Y. Superior Position Estimation Based on Optimization in GNSS. IEEE Commun. Lett. 2021, 25, 479–483. [Google Scholar] [CrossRef]
  10. Zhang, H.; Xia, X.; Nitsch, M.; Abel, D. Continuous-Time Factor Graph Optimization for Trajectory Smoothness of GNSS/INS Navigation in Temporarily GNSS-Denied Environments. IEEE Robot. Autom. Lett. 2022, 7, 9115–9122. [Google Scholar] [CrossRef]
  11. He, Y.; Li, J.; Liu, J. Research on GNSS INS & GNSS/INS Integrated Navigation Method for Autonomous Vehicles: A Survey. IEEE Access 2023, 11, 79033–79055. [Google Scholar]
  12. Chen, Z.; Li, Z.; Chen, W.; Sun, Y.; Ding, X. Wasserstein Distance-Assisted Variational Bayesian Kalman Filter With Statistical Similarity Measure for GNSS/INS Integrated Navigation. IEEE Sens. J. 2024, 24, 8807–8820. [Google Scholar] [CrossRef]
  13. Gao, W.; Zhan, X.; Yang, R. INS-aiding information error modeling in GNSS/INS ultra-tight integration. GPS Solut. J. Glob. Navig. Satell. Syst. 2024, 28, 35. [Google Scholar] [CrossRef]
  14. Shangguan, W.; Chen, J.; Xie, C.; Jiang, W. Magnetometer-enhanced Combination Positioning Method Based on IMU Error Compensation. J. China Railw. Soc. 2022, 44, 80–90. [Google Scholar]
  15. Ke, Y.; Lv, Z.; Zhang, C.; Deng, X.; Zhou, W.; Song, D. Tightly Coupled GNSS/INS Integration Spoofing Detection Algorithm Based on Innovation Rate Optimization and Robust Estimation. IEEE Access 2022, 10, 72444–72457. [Google Scholar] [CrossRef]
  16. Zhu, Z.; Lu, Y.; Xie, Z. GNSS/INS/Wheel Speed Integrated Positioning Post-Processing Algorithm Based on Iterative Smoothing. Automob. Parts 2022, z1, 41–47. [Google Scholar]
  17. Zhang, H. Research on High Precision Positioning Technology of Highway Vehicles Based on the Integration of Satellite Navigation, Inertial Navigation and Odometer, Research Report; Institute of Traffic Navigation and Perception, Southeast University, China: Nanjing, China, 2020; pp. 35–36. [Google Scholar]
  18. Qin, H.; Du, Y. An integrated positioning algorithm of Iridium opportunity signals and MEMS-INS. J. Navig. Position. 2023, 11, 45–52. [Google Scholar]
  19. Wang, J.; Chen, X.; Shi, C.; Liu, J. An Improved Robust Estimation Method for GNSS/SINS under GNSS-Challenged Environment. In Proceedings of the 2022 11th International Conference on Control, Automation and Information Sciences (ICCAIS), Hanoi, Vietnam, 21–24 November 2022; pp. 79–83. [Google Scholar]
  20. Lu, W.; Teng, Y.; Yan, X.; Jia, X.; Du, Y. Improved adaptive SRCKF algorithm for GNSS/SINS integrated navigation based on measurement characteristics. J. Chin. Inert. Technol. 2023, 31, 327–334. [Google Scholar]
  21. Chen, W.; Yang, G.; Tu, Y. A Digital Track Map-Assisted SINS/OD Fusion Algorithm for Onboard Train Localization. Appl. Sci. 2023, 14, 247. [Google Scholar] [CrossRef]
  22. Chen, H.; Zhang, Z.; Zhou, Z.; Liu, P.; Guo, Q. SINS/ODIntegrated Navigation Algorithm Based on Body Frame Position Increment for Land Vehicles. Math. Probl. Eng. 2018, 2018, 5719472. [Google Scholar]
  23. Wang, Y.F. Research on Multi-Frequency GNSS/INS/OD Fusion High-Precision Positioning Technology in Urban Environment. Master’s Thesis, Southeast University, Nanjing, China, 2021. [Google Scholar]
  24. Liu, W.; Nong, Q.; Tao, X.; Zhu, F.; Hu, J. OD/SINS adaptive integrated navigation method with non-holonomic constraints. Acta Geod. Et. Cartogr. Sin. 2022, 51, 9–17. [Google Scholar]
Figure 1. LiDAR sensor.
Figure 1. LiDAR sensor.
Applsci 14 04309 g001
Figure 2. Distance measurement when LiDAR is horizontal.
Figure 2. Distance measurement when LiDAR is horizontal.
Applsci 14 04309 g002
Figure 3. Distance measurement when LiDAR is tilted.
Figure 3. Distance measurement when LiDAR is tilted.
Applsci 14 04309 g003
Figure 4. Distance scheme for special situations.
Figure 4. Distance scheme for special situations.
Applsci 14 04309 g004
Figure 5. Nearest lane lines’ matching points.
Figure 5. Nearest lane lines’ matching points.
Applsci 14 04309 g005
Figure 6. Calculate vehicle coordinates according to lane line points.
Figure 6. Calculate vehicle coordinates according to lane line points.
Applsci 14 04309 g006
Figure 7. Comparison of the positioning trajectories of three positioning methods in a tunnel.
Figure 7. Comparison of the positioning trajectories of three positioning methods in a tunnel.
Applsci 14 04309 g007
Figure 8. Comparison of GNSS/INS combination results with the first fixed RTK point positioning after exiting the tunnel (reverse 1, yellow circle represents RTK position and red circle represents GNSS/INS position).
Figure 8. Comparison of GNSS/INS combination results with the first fixed RTK point positioning after exiting the tunnel (reverse 1, yellow circle represents RTK position and red circle represents GNSS/INS position).
Applsci 14 04309 g008
Figure 9. Comparison of GNSS/INS/OD combined results with the first fixed RTK point positioning after exiting the tunnel (reverse 1, yellow circle represents RTK position and red circle represents GNSS/INS/OD position).
Figure 9. Comparison of GNSS/INS/OD combined results with the first fixed RTK point positioning after exiting the tunnel (reverse 1, yellow circle represents RTK position and red circle represents GNSS/INS/OD position).
Applsci 14 04309 g009
Figure 10. Comparison of GNSS/INS/OD combined positioning results of lateral distance measurement lane constraint with the first fixed RTK point positioning after exiting the tunnel (reverse 1, yellow circle represents RTK position and red circle represents fusion position).
Figure 10. Comparison of GNSS/INS/OD combined positioning results of lateral distance measurement lane constraint with the first fixed RTK point positioning after exiting the tunnel (reverse 1, yellow circle represents RTK position and red circle represents fusion position).
Applsci 14 04309 g010
Figure 11. Vehicle speed inside the tunnel.
Figure 11. Vehicle speed inside the tunnel.
Applsci 14 04309 g011
Figure 12. Lateral error of GNSS/INS/OD-integrated positioning with lane constraints in a 9.2 km tunnel.
Figure 12. Lateral error of GNSS/INS/OD-integrated positioning with lane constraints in a 9.2 km tunnel.
Applsci 14 04309 g012
Table 1. Test of lateral distance measurements.
Table 1. Test of lateral distance measurements.
Test Number123
LeftRightLeftRightLeftRight
Algorithm results/m0.6971.3011.1930.8011.5650.435
Measured results/m0.7101.3151.1970.8211.5750.450
Error/m0.0130.0140.0040.0200.0100.015
Table 2. Comparison of the horizontal accuracy between the tunnel positioning points and the first fixed RTK point outside the tunnel (unit: m).
Table 2. Comparison of the horizontal accuracy between the tunnel positioning points and the first fixed RTK point outside the tunnel (unit: m).
Positioning MethodReverse 1Reverse 2
GNSS/INS251.53454.55
GNSS/INS/OD141.82329.78
Lateral Distance Measurement + Lane Markings + GNSS/INS/OD1.431.23
Table 3. Statistical analysis of lateral positioning errors in a 4.6 km midpoint tunnel.
Table 3. Statistical analysis of lateral positioning errors in a 4.6 km midpoint tunnel.
Statistical ItemsNumerical Value
Number of data points (200 Hz)61,001
Arithmetic mean of errors0.013 m
Mean absolute error0.294 m
Root mean square error 0.332 m
Maximum error value0.671 m
Minimum error value−0.865 m
95th percentile of absolute error0.612 m
Disclaimer/Publisher’s Note: The statements, opinions and data contained in all publications are solely those of the individual author(s) and contributor(s) and not of MDPI and/or the editor(s). MDPI and/or the editor(s) disclaim responsibility for any injury to people or property resulting from any ideas, methods, instructions or products referred to in the content.

Share and Cite

MDPI and ACS Style

Zhang, H.; Zhang, X. Study of Tunnel Vehicle GNSS/INS/OD Combination Position Based on Lateral Distance Measurement and Lane Line Constraint. Appl. Sci. 2024, 14, 4309. https://doi.org/10.3390/app14104309

AMA Style

Zhang H, Zhang X. Study of Tunnel Vehicle GNSS/INS/OD Combination Position Based on Lateral Distance Measurement and Lane Line Constraint. Applied Sciences. 2024; 14(10):4309. https://doi.org/10.3390/app14104309

Chicago/Turabian Style

Zhang, Hongbin, and Xu Zhang. 2024. "Study of Tunnel Vehicle GNSS/INS/OD Combination Position Based on Lateral Distance Measurement and Lane Line Constraint" Applied Sciences 14, no. 10: 4309. https://doi.org/10.3390/app14104309

APA Style

Zhang, H., & Zhang, X. (2024). Study of Tunnel Vehicle GNSS/INS/OD Combination Position Based on Lateral Distance Measurement and Lane Line Constraint. Applied Sciences, 14(10), 4309. https://doi.org/10.3390/app14104309

Note that from the first issue of 2016, this journal uses article numbers instead of page numbers. See further details here.

Article Metrics

Back to TopTop