High-precision satellite positioning method assisted by three-dimensional laser radar
Through the 3D LiDAR sensor, GNSS NLOS reception in urban canyons is detected and eliminated, and NLOS reconstruction and correction are used for 3D point cloud maps, which solves the problem of low GNSS-RTK positioning accuracy in urban canyons, achieving higher positioning accuracy and reliability.
Patent Information
- Application Number
- CN202210905688.2
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Priority Date
- 2022-04-14
- Filing Date
- 2022-07-29
- Publication Date
- 2025-05-09
- Estimated Expiration
- 2042-07-29
AI Technical Summary
In the urban canyon environment, the GNSS-RTK positioning accuracy has dropped significantly, mainly due to multipath reception caused by GNSS NLOS reception and signal occlusion, which affects the accuracy and reliability of positioning.
Using 3D LiDAR sensor to assist GNSS, 3D point cloud maps are generated by data received from 3D LiDAR and IMU, GNSS NLOS reception is detected and excluded, and the generated point cloud map is used for NLOS reconstruction and correction, thereby improving the accuracy of GNSS positioning.
In the urban canyon environment, the 3D LiDAR-assisted GNSS method can significantly improve positioning accuracy, reaching 10 cm accuracy, meeting the navigation needs of autonomous vehicles.
Smart Images

Figure CN115343745B_ABST
Abstract
Description
Technical Field
[0001] The present disclosure generally relates to the field of autonomous driving or other types of autonomous systems for intelligent transportation systems. Specifically, the present disclosure relates to a 3D LiDAR-assisted global navigation satellite system and method for NLOS detection and correction, which can improve positioning performance. Background Art
[0002] Autonomous driving is widely recognized as a remedy to excessive traffic congestion and expected accidents. However, the insufficient positioning accuracy of current solutions is one of the key issues hindering the arrival of autonomous driving in urban scenarios. As the demand for ADVs continues to increase, positioning in urban environments becomes critical.
[0003] GNSS, such as GPS and / or other similar satellite-based positioning technologies, is currently one of the primary means of providing global reference positioning for ADV positioning for intelligent transportation systems. With the increasing availability of multiple satellite constellations, GNSS can provide satisfactory performance in open sky areas. However, it is a challenging problem that the performance of GNSS degrades severely when large parts of the sky are obscured. This situation is known as the "urban canyon" scenario. Typically, in highly urbanized cities, positioning accuracy degrades significantly due to signal reflections caused by static buildings and dynamic objects.
[0004] In particular, GNSS-RTK is used for high-precision aerial mapping and positioning of Level 4 fully autonomous vehicles. Typically, GNSS-RTK positioning involves two steps: (1) estimating a floating-point solution based on received GNSS measurements; (2) resolving integer ambiguities using a least squares algorithm (e.g., LAMBDA) based on the derived floating-point solution as an initial guess. In the case of achieving a fixed solution, centimeter-level positioning accuracy can be achieved based on double differential carrier and coded measurements in open areas. Unfortunately, the accuracy of GNSS-RTK is significantly reduced in urban canyons due to NLOS and multipath reception caused by GNSS signal reflections and obstruction by surrounding buildings. In practice, the significant decrease in GNSS-RTK positioning accuracy in urban canyons is mainly caused by the occurrence of GNSS NLOS reception. Due to NLOS reception, the performance of GNSS positioning is highly affected by real-time surrounding environment features such as buildings and dynamic objects. Some of the received GNSS signals are severely contaminated, including large noise. According to the inventors' previous research, in highly urbanized areas, most of the received GNSS signals can be multipath or NLOS reception. Therefore, the accuracy of the floating-point solution estimate based on differential carrier and coding measurements is reduced, making it difficult to obtain a fixed solution for ambiguity resolution.
[0005] In addition, the number of available satellites in urban canyons is limited due to signal obstruction from surrounding buildings. As a result, the geometry of the satellite distribution is distorted, resulting in a large DOP. As a result, the search space ambiguity is large due to poor satellite geometry, making it difficult to obtain a fixed solution. In short, urban canyon scenarios bring additional difficulties to both steps of GNSS-RTK positioning.
[0006] Therefore, effectively sensing and understanding the surrounding environment is key to improving GNSS positioning in urban areas, as GNSS positioning heavily relies on sky view visibility. The most well-known method to deal with GNSS NLOS reception is 3DMA GNSS positioning, such as NLOS exclusion and shadow matching based on 3D map construction information. However, the disadvantages of these 3DMA GNSS methods are 1) dependence on the availability of 3D building models and initial guesses of the GNSS receiver position; and 2) inability to mitigate NLOS reception caused by surrounding dynamic objects. The latest progress of 3DMA GNSS positioning methods is reviewed in detail in the inventors' previous work.
[0007] In the inventors’ recent publication, 3D LiDAR sensors, the typical and indispensable onboard sensors of autonomous vehicles, which are called the “eyes” of ADVs, have been used to detect NLOS caused by dynamic objects. Due to the limited -30°~+10° FOV of 3D LiDAR, only a portion of a double-decker bus could be scanned. Moreover, the method heavily relies on the accuracy of object detection. Nevertheless, this is the first work to employ real-time object detection to assist GNSS positioning. Instead of detecting only dynamic objects, methods were explored to detect surrounding buildings using real-time 3D LiDAR point clouds. Due to the limited field of view of 3D LiDAR, only a portion of buildings could be scanned. Therefore, information about the building height is required to detect NLOS reception caused by buildings. Instead of excluding detected NLOS reception, the inventors explored alternatives to correct NLOS pseudorange measurements with the help of LiDAR. 3D LiDAR can measure the distance from the GNSS receiver to the building surface that may have reflected the GNSS signal. Then, both the corrected and remaining healthy GNSS measurements can be used for further GNSS positioning. Improved performance was obtained after correcting the detected NLOS satellites. However, the performance of this approach relies on the accuracy of building and reflector detection. Both building detection and reflector detection may fail when the building surface is highly irregular. The limited FOV of LiDAR remains a disadvantage in the detection of dynamic objects and buildings. Overall, previous work has shown the feasibility of detecting GNSS NLOS using real-time airborne sensing (real-time point cloud). In order to overcome the disadvantage of limited FOV of 3D LiDAR, the inventors explored the use of fisheye cameras and 3D LiDAR to detect and correct NLOS signals. Fisheye cameras are used to detect non-line-of-sight signals. At the same time, 3D LiDAR is used to measure the distance between the GNSS receiver and potential reflectors that cause NLOS signals. However, this approach suffers from the problem that NLOS detection is sensitive to ambient lighting conditions.
[0008] Therefore, there is a need in the art for improved positioning methods and systems, particularly for autonomous driving capable of achieving high-precision positioning in very deep urban canyons. In addition, other desirable features and characteristics will become apparent from the subsequent detailed description and the appended claims, taken in conjunction with the accompanying drawings and background of the present disclosure. Summary of the invention
[0009] A 3D LiDAR-assisted GNSS NLOS mitigation method and a system implementing the method are provided. The purpose of the present disclosure is to provide a method for mitigating NLOS caused by static buildings and dynamic objects.
[0010] The first aspect of the present disclosure provides a method for supporting vehicle positioning using a satellite positioning system. The method includes: receiving LiDAR factors and IMU factors from a 3D LiDAR sensor and LIO; optimizing the integrated LiDAR factors and IMU factors using a local factor graph to estimate the relative motion between two epochs; generating a 3D PCM as an auxiliary landmark satellite for providing low-elevation auxiliary landmark satellites; receiving GNSS measurements from satellites through a GNSS receiver; detecting GNSS NLOS reception from the GNSS measurements using 3D PCM; and excluding the GNSS NLOS reception from the GNSS measurements to obtain surviving GNSS satellite measurements, thereby improving the quality of GNSS measurements used for autonomous vehicle positioning.
[0011] In one embodiment, the method further comprises: performing GNSS-RTK float estimation on the surviving GNSS satellite measurements to obtain a float solution; performing ambiguity resolution to obtain a fixed ambiguity solution; and determining a fixed GNSS-RTK positioning solution from the float solution and the fixed ambiguity solution.
[0012] In one embodiment, the ambiguity resolution is performed by applying the LAMBDA algorithm.
[0013] In one embodiment, the method further comprises: feeding back the fixed GNSS-RTK positioning solution to the 3D LiDAR sensor and the LIO; and performing PCM correction using the fixed GNSS-RTK positioning solution to correct the drift of the 3D point cloud.
[0014] In one embodiment, the method further comprises: obtaining an initial guess of the float solution using a least squares algorithm on the GNSS measurements.
[0015] A second aspect of the present disclosure provides a method for supporting vehicle positioning using a satellite positioning system. The method includes: generating a sliding window map (SWM) in real time based on a 3D point cloud from a 3D LiDAR sensor and an AHRS, wherein the SWM provides an environmental description for detecting and correcting NLOS reception; accumulating 3D point clouds from previous frames into the SWM to enhance the FOV of the 3D LiDAR sensor; receiving GNSS measurements from a satellite through a GNSS receiver; detecting the NLOS reception from the GNSS measurements using the SWM; correcting the NLOS reception through NLOS reconstruction when a reflection point is not found in the SWM; and estimating GNSS positioning through a least squares algorithm.
[0016] In one embodiment, the method further comprises: minimizing the point cloud capacity of the SWM by excluding point clouds far away from the GNSS receiver so that the 3D point cloud is within a sliding window.
[0017] In one embodiment, the step of generating the SWM includes: obtaining a local map from LiDAR scan matching based on the 3D point cloud from a 3D LiDAR sensor; and converting the SWM from a carrier coordinate system to a local East-North-Upper-Sky (ENU) coordinate system using the direction of the AHRS.
[0018] In one embodiment, the step of detecting the NLOS reception from the GNSS measurement value is performed using a fast search method, wherein the fast search method includes: initializing a search point at the center of the 3D LiDAR sensor; determining a search direction connecting the GNSS receiver and the satellite according to the elevation angle and azimuth angle of the satellite; and determining the search direction of the 3D LiDAR sensor according to the elevation angle and azimuth angle of the satellite. pix Move the search point along the search direction; calculate the neighboring points (N k ) number; and if N k Exceeding the predetermined threshold N thres , the search point is classified as a NLOS satellite.
[0019] In an embodiment, the method further comprises correcting the NLOS reception by re-estimating the GNSS measurements using a model calibration based on the SWM, wherein the SWM provides a dense, discrete and unorganized 3D point cloud without continuous building surfaces or boundaries.
[0020] In one embodiment, the model calibration includes: using an efficient kdTree structure based on a reflector detection algorithm to detect the reflection point corresponding to the NLOS reception, wherein the reflector detection algorithm includes: traversing all azimuths from 0° to 360° with an azimuth resolution of α res , the elevation angle is When the connection point p j detecting a potential reflector when the line of sight to the satellite is not blocked; and detecting a unique reflector having a shortest distance between the GNSS receiver and the potential reflector.
[0021] In one embodiment, the NLOS uses a weighting scheme with a scaling factor to perform the NLOS reconstruction. The scaling factor is used to de-weight the NLOS reception, and the weighting scheme includes the following definitions: if the satellite is classified as a LOS measurement, the scaling factor is calculated based on the satellite signal-to-noise ratio (SNR) and the elevation angle; if the satellite is classified as a NLOS measurement and the pseudorange error is corrected, the scaling factor is calculated based on the satellite SNR and the elevation angle; and if the satellite is classified as a NLOS measurement but no reflection point is detected, the scaling factor is calculated based on the satellite SNR, the elevation angle and the scaling factor K w The scaling factor is calculated.
[0022] This summary is provided to introduce a selection of concepts in a simplified form, which are further described in the detailed description below. This summary is not intended to identify the key features or essential features of the claimed subject matter, nor is it intended to be used as an aid in determining the scope of the claimed subject matter. Other aspects and advantages of the present invention are disclosed as shown in the following examples. BRIEF DESCRIPTION OF THE DRAWINGS
[0023] The drawings include drawings for further illustrating and clarifying the above and other aspects, advantages and features of the present disclosure. It should be understood that these drawings depict only certain embodiments of the present disclosure and are not intended to limit the scope thereof. It should also be understood that these drawings are shown for simplicity and clarity and are not necessarily drawn to scale. The present disclosure will now be described and explained with additional specificity and detail through the use of the accompanying drawings, in which:
[0024] Figure 1 is a schematic diagram of a 3D LiDAR-assisted GNSS real-time dynamic differential positioning method according to an exemplary embodiment of the present disclosure;
[0025] Figure 2 is a schematic diagram of a 3D LiDAR-assisted GNSS NLOS mitigation method according to an exemplary embodiment of the present disclosure;
[0026] Figure 3 is an exemplary demonstration of a sliding window map and a real-time 3D point cloud generated according to an exemplary embodiment of the present disclosure;
[0027] Figure 4 It is a schematic diagram of the coordinate system used in the present invention.
[0028] Figure 5 is a conceptual diagram illustrating NLOS detection based on a generated sliding window map according to an exemplary embodiment of the present disclosure;
[0029] Figure 6 It reconstructs and corrects the polluted GNSS signals by sensing the world;
[0030] Figure 7 This is the positioning performance before and after the application of the 3D LiDAR-assisted GNSS real-time dynamic differential positioning method according to an embodiment of the present invention.
[0031] Figure 8 is a system diagram of a 3D LiDAR-assisted GNSS configured to utilize a 3D LiDAR-assisted GNSS NLOS mitigation method and incorporated into a vehicle according to an embodiment of the present disclosure. DETAILED DESCRIPTION
[0032] The present disclosure is primarily provided to the field of autonomous driving or other types of autonomous systems with navigation requirements using satellite positioning systems. The vehicle may be an ADV, or a vehicle equipped with ADAS. More specifically, but not limited to, the present disclosure provides a 3D LiDAR-assisted GNSS NLOS mitigation method that can detect and correct NLOS signals in very deep urban canyons, and the system implements the method. The purpose of the present disclosure is to provide a method for mitigating NLOS caused by static buildings and dynamic objects, thereby achieving high accuracy in highly densely urbanized areas.
[0033] Effects, advantages, solutions to problems, and any elements that may cause any effect, advantage, or solution to occur or become more apparent are not to be construed as critical, required, or essential features or elements of any or all the claims. The present invention is defined solely by the appended claims including any amendments made during the pendency of this application and all equivalents of those claims as issued.
[0034] In the following claims and the foregoing description of the invention, unless the context requires otherwise due to express language or necessary implication, the word "comprise" or variations thereof, such as "comprises" or "comprising", is used in an inclusive manner, i.e., specifying the presence of stated features but not excluding the presence or addition of further features in various embodiments of the invention.
[0035] As used herein, the term "Global Navigation Satellite System" or "GNSS" refers to a general purpose satellite-aided navigation system in which electronic receivers can determine their position with a specified accuracy using line-of-sight radio signals transmitted by satellites. A GNSS receiver can receive and process signals from multiple satellites orbiting the Earth to determine the position of the GNSS receiver, and position conversion to determine the position of the vehicle. For the purposes of this invention, unless otherwise specified, the status of the GNSS receiver and the positions of the satellites are expressed in the ECEF coordinate system.
[0036] The term "LiDAR sensor" refers to a sensor that is capable of measuring the distance from a vehicle to an object by emitting a laser beam to the object and measuring the reflected portion of the laser beam to calculate the distance.
[0037] The term "attitude heading reference system" or "AHRS" refers to a system having one or more sensors configured to use vibrations to measure changes in the direction, orientation, and / or acceleration of a vehicle based on a vertical reference.
[0038] The first embodiment of the present disclosure is to detect and exclude GNSS NLOS reception to further improve GNSS-RTK positioning. At the same time, it is also of great significance to use the improved GNSS-RTK positioning to correct the drift of the 3D point cloud, thereby improving the overall positioning accuracy.
[0039] Figure 1 An overview of the 3D LiDAR-assisted GNSS-RTK positioning method proposed in this disclosure is provided. The system includes two parts: (1) real-time environment description generation based on the cloud from 3D LiDAR and IMU, and correction from GNSS-RTK solution S100A; (2) GNSS NLOS detection and elimination based on real-time environment description, and GNSS-RTK positioning based on S100B surviving satellites.
[0040] In some embodiments, the use of a 3D LiDAR sensor 110 improves GNSS-RTK positioning in urban canyons by essentially solving the problems of conventional GNSS-RTK due to signal reflection and occlusion. First, a 3D LiDAR sensor 110 and LIO 120 are executed, which receive and loosely integrate LiDAR factors and IMU factors using a local factor graph optimization 141 to estimate the relative motion between two epochs and generate a 3D PCM to provide an environmental description. The LiDAR factors are obtained from LiDAR scan matching 111, and the IMU factors are obtained from pre-integration 121. The environmental description used here is a local environmental description. In some embodiments, the 3D LiDAR sensor 110 is a Velodyne 32 configured to collect raw 3D point cloud data at a frequency of 10 Hz, and the LIO 120 is an Xsens Ti-10 IMU configured to collect data at a frequency of 100 Hz. And, the position of the surrounding point cloud is estimated at the same time. Therefore, PCM correction 142 is performed by using the position estimate of the surrounding point cloud on the 3D PCM. The effect is that the method can advantageously generate a locally accurate PCM.
[0041] Secondly, potential GNSS NLOS satellites are detected and excluded with the help of the environmental description. The GNSS receiver 130 receives GNSS measurements from the satellites, which can use a traditional least squares algorithm 131 to derive an initial guess for a float solution. In some embodiments, the GNSS receiver 130 is a commercial grade u-blox F9P GNSS receiver for collecting raw GPS / Beidou measurements at a data rate of 1 Hz. In addition, a NovAtel SPAN-CPT, GNSS (GPS, GLONASS and Beidou) RTK / INS (Fiber Optic Gyroscope, FOG) integrated navigation system can be used to provide ground truth positioning. All data is collected and synchronized using ROS.
[0042] For subsequent GNSS NLOS detection, the first embodiment of the present disclosure does not rely on an initial guess of a floating point solution from the GNSS receiver 130. Instead, GNSS NLOS receptions are detected from GNSS measurements using a 3D PCM generated by LiDAR or an inertial integration and correlation algorithm. Thus, the problem of poor quality of GNSS measurements can be mitigated using GNSS NLOS exclusion 151, which essentially excludes potential GNSS NLOS receptions to obtain surviving GNSS satellite measurements.
[0043] To solve this problem, the present disclosure proposes to use landmarks from the generated point cloud map as "auxiliary landmark satellites" to fundamentally improve the satellite geometry. Advantageously, the auxiliary landmark satellites and the receiving satellites complement each other as point cloud maps, and low-elevation auxiliary landmark satellites can be provided. Such low-elevation auxiliary landmark satellites are generally unavailable for physically received satellites. To this end, contaminated GNSS NLOS satellites are excluded, and the satellite geometry is improved with the help of auxiliary landmark satellites.
[0044] Next, a float solution can be estimated based on the surviving GNSS satellite measurements by performing a GNSS-RTK float estimation 152 to obtain a float solution, and then performing an ambiguity solution 153 to obtain a fixed ambiguity solution. In some embodiments, the ambiguity solution 153 is performed by applying a LAMBDA algorithm. Finally, the estimated fixed GNSS-RTK positioning solution 154 is fed back to the 3D LiDAR sensor and LIO to perform a PCM correction 142 to further correct the drift of the 3D point cloud. By combining the improved GNSS-RTK positioning assisted by GNSS NLOS detection, the method can essentially correct the drift of the 3D point cloud map generated by LiDAR or inertial integration. Therefore, the proposed method effectively combines the complementarity of LIO (in a locally accurate manner in a short time and providing environmental description for GNSS NLOS detection) and GNSS-RTK (drift-free, with global reference positioning but affected by GNSS NLOS).
[0045] The first embodiment of the present disclosure solves this problem by leveraging the perception capabilities of the 3D LiDAR sensor to detect and exclude potential GNSS NLOS reception. This approach can achieve an accuracy of 10 cm even in urban canyon scenarios to meet the navigation requirements of autonomous driving. In the second embodiment of the present disclosure, an alternative method and system are provided that employs 3D LiDAR to assist GNSS single-point positioning. Positioning is only accurate within a range of 5 meters, which is not as accurate as the GNSS-RTK of the first embodiment.
[0046] refer to Figure 2 , illustrates an overview of the 3D LiDAR-assisted GNSS NLOS mitigation method. The system consists of two parts: (1) real-time SWM generation S200A based on 3D point cloud from 3D LiDAR sensor and AHRS; (2) GNSS NLOS detection and correction S200B based on real-time environment description.
[0047] Advantageously, the SWM is generated based on a real-time 3D point cloud from the 3D LiDAR sensor 110, wherein only the 3D point cloud within a sliding window is used to generate the SWM, since point clouds far from the GNSS receiver 130 are not necessary for NLOS detection. Therefore, the size of the SWM can be minimized. The SWM is first generated using the 3D LiDAR sensor 110 and the AHRS 160, wherein the SWM essentially provides an environmental description for detecting and correcting NLOS reception. Based on the 3D point cloud from the 3D LiDAR sensor 110, a local map is obtained from LiDAR scan matching 211. Directions from the AHRS 160 are directly employed to transform the SWM from the carrier coordinate system to the local ENU coordinate system.
[0048] By performing the local transformation 241, a SWM can be generated, which is performed in real time for GNSS NLOS detection. This is crucial to achieving better environmental description capabilities, thereby enhancing the FOV of LiDAR sensing. In traditional methods, only real-time 3D point clouds are applied to further detect NLS satellites. However, the ability of NLOS detection is limited by the FOV of the 3D LiDAR sensor 110. In this regard, the second embodiment of the present disclosure improves the deficiencies of the prior art by accumulating real-time point clouds into SWM. The FOV of the 3D LiDAR sensor 110 can be effectively enhanced.
[0049] References Figure 3Figure 1 shows the perceived digital world, which shows the difference between the real-time 3D LiDAR point cloud and the SWM. The perceived environment opens a new window to reveal the effects of occlusion or reflection of GNSS signal transmission caused by surrounding high-rise buildings, etc. The 3D LiDAR sensor 110 has a limited FOV, and a single-frame 3D point cloud can only effectively detect low-lying parts of buildings and vehicles (such as double-decker buses). The visibility of high-elevation satellites cannot be effectively classified simply based on the real-time 3D point cloud. The real-time 3D point cloud is also sparse due to the physical scanning angle distribution of the 3D LiDAR sensor 110.
[0050] The above problems can be effectively improved by using the SWM disclosed in the present invention. Figure 3 (Ground points are removed from SWM for effective NLOS detection). With the help of SWM, the cut-off elevation angle can be achieved to 76°, so the visibility of satellites with elevation angles less than 76° can be classified. The point cloud in SWM is much denser than the original real-time 3D point cloud, which can significantly improve the accuracy of NLOS detection. A snapshot of the complete SWM map is shown in Figure 3 Buildings and dynamic objects such as double-decker buses and even trees are included in the SWM that were not included in the 3D building model.
[0051] In order to generate a point cloud map based on a real-time 3D point cloud, the SLAM method is usually used. In fact, satisfactory accuracy can be obtained with low drift in a short time. However, the error accumulates over time, resulting in large errors after long-term travel, and closed loops are usually not possible. Therefore, in practical applications, only objects within a circle with a radius of about 250 meters can cause GNSS NLOS reception, while distant buildings are ignored.
[0052] Reference Figure 4 , showing the transformation of the coordinate system. The ECEF coordinate system is fixed to the center of the earth. The first point is selected as the reference of the ENU coordinate system, while the external parameters between the LiDAR, AHRS and GNSS receivers are fixed and calibrated in advance. The L coordinate system (ENU) is obtained by Convert to G coordinate system (ECEF).
[0053] The present disclosure uses only the last Nsw coordinate system of the 3D point cloud to generate the sliding window map. As a result, the drift error of the map generation is therefore limited to a very small value and is determined by the size of the window (Nsw). In order to minimize the apparent drift in the vertical direction in urban canyons with a large number of dynamic objects, the present disclosure uses an absolute ground plane to constrain the vertical drift. The details of the SWM generation algorithm are demonstrated below:
[0054] Input: from epoch tNsw +1 to a series of point clouds from epoch t are the external parameters between 3D LiDAR, AHRS and GNSS receivers.
[0055] Output:
[0056] Step 1: Initialization
[0057] Step 2: SWM generation:
[0058] First, all point clouds To is the local map of the first coordinate system Secondly, use the following equation to convert the local map A point within Transformed to the receiver carrier coordinate system
[0059]
[0060] Third, the local map is transformed into A point within Converted to ENU coordinate system
[0061] Now return to reference Figure 2 , the second part of GNSS NLOS detection and correction S200B for GNSS pseudorange measurements is set with four stages. First, GNSS NLOS detection 251 is used for model verification based on satellite visibility classification using SWM, which can effectively identify LOS satellites and NLOS satellites. Next, if a satellite is classified as NLOS, a GNSSNLOS correction 252 is performed as a model calibration stage, which re-estimates the GNSS measurements by correcting the NLOS pseudorange measurements (CNLOS). However, if a satellite is classified as NLOS and its reflection point is not within the SWM (FNLOS), it means that the NLOS correction is not available. The third stage is to perform NLOS reconstruction 253, which is a model repair stage by de-weighting the NLOS measurements for further positioning. The GNSS positioning is estimated based on the pseudorange measurements by a least squares algorithm 254.
[0062] GNSS NLOS Detection via Model Validation 251
[0063] No object detection algorithm is required to recover the actual height of detected dynamic objects or building surfaces. Since SWM only provides unorganized discrete points, a fast search method based on real-time SWM is used to directly detect NLOS reception without the need for object detection process.
[0064] The inputs for the quick search method include: Satellite s elevation angle Azimuth at epoch t Maximum search distance D thres and constant increment value Δd pix The fast search method is used to determine the satellite visibility of satellite s. In step 1, in the ENU coordinate system, The 3D LiDAR center shown is initialized to search the point. The search direction connecting the GNSS receiver 130 and the satellite is determined by the elevation angle and azimuth angle of the satellite. The SWM is converted into a kdTree structure Used to find adjacent points. kdTree is a special structure for point cloud processing that can be performed efficiently when searching for adjacent points. In step 2, a fixed increment value Δd is given pix , using the following equation, according to Figure 5 The search direction shown in the example moves the search point to the next point
[0065]
[0066]
[0067]
[0068] k represents the index of the search point. Calculate the neighboring points near the search point (N k ) According to step 3, if N k Exceeding the predetermined threshold N thres , then at the search point There are some map points from buildings or dynamic objects nearby, and the line of sight connecting the GNSS receiver 130 and the satellite is considered to be blocked. Therefore, the satellite s is classified as a NLOS satellite. Otherwise, repeat the above steps 2 and 3. If kΔd pix >D thres , then the direction between the GNSS receiver 130 and the satellite is along the LOS. thres Can be set to define the distance within which positions are considered for NLOS detection. Using a fast search method, satellite visibility can be classified.
[0069] A demonstration of satellite visibility classification results with NLOS and LOS satellites is shown in Figure 6 . The grey circles represent contaminated (multipath effect) GNSS satellites and the white circles represent healthy GNSS satellites. The numbers provided next to each circle represent the elevation angle of each satellite. From this example, an elevation angle of 54° was detected. As mentioned earlier, the maximum cut-off elevation angle is 76°, and the elevation angle based on SWM may be significantly related to the street width. The narrower the street, the higher the cut-off elevation angle can be achieved. However, NLOS satellites with low elevation angles may cause most of the GNSS positioning errors. Even for challenging urban canyons, the present disclosure is provided to detect and recover signal occlusions and reflections to achieve highly accurate GNSS positioning.
[0070] GNSS NLOS corrections via model calibration 252
[0071] NLOS correction is performed by SWM-based model calibration. In order to effectively estimate potential NLOS errors, the distance between GNSS receivers, satellite elevation and azimuth angles need to be based on the NLOS error model. In particular, model calibration includes detecting reflection points corresponding to NLOS reception. Traditionally, ray tracing techniques are used to simulate NLOS signal transmission paths to find NLOS reflectors. However, this technique has the disadvantage of high computational power. The present disclosure provides a method that does not produce continuous building surfaces and clear building boundaries. Instead, SWM only provides a large number of dense, discrete, unorganized point clouds. The search for reflectors from SWM is performed using an effective kdTree structure based on a reflector detection algorithm.
[0072] The inputs to the reflector detection algorithm used to perform model calibration include: Satellite s elevation angle Azimuth at epoch t and the azimuth resolution α res The output is the nearest reflection point It is the most likely reflecting surface for NLOS satellites.
[0073] In step 1, a search point is initialized at the center of the 3D LiDAR. The search direction is based on the satellite elevation angle and azimuth Sure.
[0074] For a typical signal reflection path, there are two segments. The first segment is the signal transmission from the satellite to the reflector. The second segment is the signal transmission from the reflector to the GNSS receiver 130. Since the reflected signal should have the same elevation angle as the expected directional signal, step 2 of the reflector detection algorithm includes traversing all azimuths from 0° to 360° with an azimuth resolution of α res , the elevation angle is Thus, all possible NLOS transmission paths are found.
[0075] In step 3, if the distance associated with the direction is j If it is blocked, then the point p j may be a reflection point. In particular, if the connection point p j The line of sight to the satellite is not blocked, then point p j are considered possible reflectors and saved to
[0076] In step 4, repeat steps 2 and 3 until α s >360°, thereby identifying all possible reflectors based on the assumption of the same elevation angle.
[0077] Finally, step 5 is based on the shortest distance assumption, from A unique reflector is detected at the shortest distance between the GNSS receiver 130 and the reflector.
[0078] Advantageously, the reflector detection algorithm does not rely on the detection accuracy of building surfaces. The short range assumption can effectively prevent overcorrection because only the nearest reflector is identified as the only reflector. The potential NLOS delay of satellite s can be calculated as:
[0079]
[0080] Where the operator ||*|| is used to calculate the norm of a given vector. sec(*) represents the secant function. Due to the sparsity of SWM, although it is still denser than the 3D real-time point cloud, there are still some satellites whose reflectors cannot be found using SWM. Therefore, if a satellite is classified as NLOS but its reflection point is not found inside SWM, NLOS reconstruction is recommended.
[0081] NLOS reconstruction for model repair 253
[0082] Satellites with lower elevation angles and smaller SNRs have a higher probability of being contaminated by NLOS errors. Traditional pseudorange uncertainty modeling methods based on satellite elevation angle and signal-to-noise ratio can produce satisfactory performance in open areas, but not in deep urban canyons. In particular, weighting schemes treat LOS and NLOS in the same way, which is undesirable when NLOS has been detected. The present disclosure corrects GNSS NLOS reception by performing NLOS reconstruction, which essentially models the uncertainties of LOS and NLOS using a weighting scheme, in which a scaling factor is added to de-weight the NLOS measurements. The weighting scheme includes: (1) if the satellite is classified as a LOS measurement, the scaling factor is calculated based on the satellite SNR and elevation angle; (2) if the satellite is classified as a NLOS measurement and the pseudorange error is corrected, the scaling factor is calculated based on the satellite SNR and elevation angle; (3) if the satellite is classified as a NLOS measurement but no reflection point is detected, the scaling factor is calculated based on the satellite SNR and elevation angle and the scaling factor K w Calculate the scale factor.
[0083] GNSS Positioning via Least Squares Algorithm254
[0084] Pseudorange measurements from GNSS receivers It is expressed as:
[0085]
[0086] in:
[0087] is the geometric range between the satellite and the GNSS receiver;
[0088] is the ionospheric delay distance;
[0089] is the tropospheric delay distance; and
[0090] It is the noise caused by multipath effect, NLOS reception, receiver noise and antenna phase correlation noise.
[0091] At the same time, the traditional Saastamoinen model and Klobuchar model are used to compensate for the atmospheric effect ( and ). The observation model of the GNSS pseudorange measurements from a given satellite s is expressed as:
[0092]
[0093]
[0094] in, is with Correlated noise.
[0095] Assume that before being used for further GNSS positioning Subtract the NLOS error from Observation function The Jacobian matrix It can be expressed as:
[0096]
[0097] Where m represents the total number of satellites at epoch t.
[0098] The position of a GNSS receiver can be estimated iteratively by weighted least squares as follows:
[0099]
[0100] Among them, W t represents the weight matrix based on the weights estimated in NLOS reconstruction 253 as follows:
[0101]
[0102] in,
[0103]
[0104] The weights defined to calculate the LOS measurements based on the satellite SNR and elevation angle are as follows:
[0105]
[0106] Wherein, T represents the signal-to-noise ratio threshold; a, A, and F are predetermined.
[0107] Figure 7 Positioning performance before and after the application of the 3D LiDAR-assisted GNSS real-time dynamic differential positioning method developed for the first embodiment of the present invention. The experience of traditional GNSS solutions has an error of about 30 meters, resulting in misjudgment of the lane of the vehicle driving in the urban canyon. The improved technology can provide powerful and accurate positioning results to support the operation of L4 autonomous vehicles.
[0108] Experimental Results
[0109] To verify the effectiveness of the proposed method, two experiments were conducted in typical urban canyons with static buildings, trees, and dynamic objects (e.g., double-decker buses). The first experiment was conducted in Urban Canyon 1 with a street width of 22 meters and a building height of 35 meters. The second experiment was conducted in Urban Canyon 2 with a street width of 12.1 meters and a building height of 65 meters.
[0110] The vehicle is equipped with a u-blox M8TGNSS receiver for collecting raw GNSS measurements at 1Hz. The 3DLiDAR sensor is a Velodyne 32 configured to collect raw 3D point clouds at 10Hz. An Xsens Ti-10 INS is used to collect data at 100Hz. In addition, a NovAtel SPAN-CPT, a GNSS (GPS, GLONASS and BeiDou) RTK / INS (Fiber Optic Gyroscope, FOG) integrated navigation system is used to provide ground truth positioning. The FOG has a gyro bias operational stability of 1 degree per hour and a random walk of 0.067 degrees per hour. The baseline between the rover and the GNSS base station is approximately 7 km. All data is collected and synchronized using ROS. The following five configurations were evaluated: (1) u-blox GNSS receiver only; (2) weighted least squares (WLS); (3) weighted least squares excluding all NLOS satellites (WLS-NE); (4) weighted least squares with re-weighting of all NLOS satellites (R-WLS); and (5) weighted least squares with NLOS correction if a reflector is detected and re-weighting of NLOS satellites if no reflector is detected (CR-WLS).
[0111]
[0112] Table 1: Localization performance of GNSSSPP in urban canyon 1
[0113] The results of the GNSS positioning experiments using the five methods are shown in Table 1 above. The positioning results using the u-blox receiver have an average error of 31.02 meters and a standard deviation of 37.69 meters. Due to severe multipath and NLOS reception from surrounding buildings, the maximum error reaches 177.59 meters. For WLS, the positioning error drops to 9.57 meters with a standard deviation of 7.32 meters. The maximum error is also reduced to less than 50 meters. After excluding all detected non-line-of-sight satellites, the positioning error increases to 11.63 meters, which is worse than WLS. This happens because excessive NLOS exclusion significantly distorts the perceived geometric distribution of satellites. The availability drops slightly from 100% to 96.01%. Therefore
[0114]
[0115] Table 2: Localization performance of GNSSSPP in Urban Canyon 2
[0116] In the more challenging case of Urban Canyon 2, it was found that some NLOS satellites reflected by buildings higher than 40 meters may not be detected. A positioning error of 30.68 meters was obtained using the u-blox receiver with a maximum error of 92.32 meters. A GNSS positioning error of 23.79 meters was obtained using WLS based on the raw pseudorange measurements from the u-blox receiver. The maximum error increased slightly to 104.83 meters compared to the GNSS positioning using data directly from the u-blox receiver. After excluding all detected NLOS satellites from the GNSS positioning (WLS-NE), the mean and standard deviation increased to 25.14 meters and 23.73 meters, respectively. Due to the lack of satellites for GNSS positioning, the availability of GNSS positioning data dropped to 95.52%, which again shows that completely excluding NLOS in urban canyons is not desirable. With the help of NLOS reconstruction, the 2D error using R-WLS was reduced to 19.61 meters. One hundred percent availability is guaranteed. The GNSS positioning error was further reduced to 17.09 meters using the CR-WLS method. The improvement in the results demonstrates the effectiveness of the proposed 3D LiDAR-aided GNSS positioning method. The maximum error still reaches 71.28 meters because not all NLOS satellites can be detected and mitigated.
[0117] Figure 8 is a system diagram of one possible implementation and combination of a 3D LiDAR-assisted GNSS NLOS mitigation method in a vehicle according to an exemplary embodiment of the present disclosure. The vehicle uses LiDAR-assisted GNSS to support the vehicle in positioning using a satellite positioning system. In some embodiments, the system includes a 3D LiDAR sensor 110, an AHRS 160, a GNSS receiver 130, a processor 810, a memory 820, a user interface 830, an autonomous control 840, and a communication interface 850. In some embodiments, without departing from the scope and spirit of the present disclosure, the 3D LiDAR sensor 110, the AHRS 160, and / or the GNSS receiver 130 can be integrated into the processor 810. In this case, the processor 810 is a dedicated device with built-in components capable of receiving GNSS satellite signals, directions, and / or local 3D point cloud maps.
[0118] The processor 810 may be one or more general purpose processors, dedicated processors, digital signal processing chips, application specific integrated circuits (ASICs), or other processing structures that may be configured to perform one or more of the above methods described below. The processor 810 is communicatively connected to the 3D LiDAR sensor 110, the AHRS 160, and the GNSS receiver 130 for receiving local maps, directions, and GNSS measurements, respectively. The processor 810 may include a memory 820, or communicate with the memory 820 (as a discrete component) for storing positioning data and / or other received signals and retrieving previous keyframe point cloud data for SWM that is useful for enhancing the FOV of the 3D LiDAR sensor 110.
[0119] In some embodiments, the memory 820 may include, but is not limited to, a solid-state storage device, such as a random access memory (RAM) and / or a read-only memory (ROM), which may be programmable, flash-updatable, and / or the like. Such a storage device may be configured to implement any appropriate data storage, including but not limited to various file systems, database structures, and the like. The memory 820 may also include software instructions configured to cause the processor 810 to perform one or more functions according to the method disclosed herein. Therefore, the above functions and methods may be implemented as computer codes and / or instructions executable by the processor 810. Then, in one aspect, such codes and / or instructions may be used to configure and / or adapt a computer (or other computer device) to perform one or more operations according to the described method. The memory 820 may therefore include a non-transitory machine-readable medium having instructions and / or computer code embedded therein. Common forms of computer-readable media include, for example, a hard disk, a magnetic or optical medium, a RAM, a PROM, an EPROM, a FLASH-EPROM, a USB memory stick, any other storage chip or cartridge, a carrier wave, or any other medium from which a computer can read instructions and / or codes.
[0120] The user interface 830 allows interaction with the driver, passengers, and / or other individuals controlling the vehicle, and may include one or more input devices selected from the group consisting of a touch screen, a touch pad, buttons, switches, a microphone, etc. The driver or person controlling the vehicle may use the user interface 830 to activate or deactivate the autonomous controls 840, or to select different operating modes and / or degrees of autonomous driving.
[0121] Autonomous control 840 is an output device for controlling the vehicle based on GNSS positioning. Processor 810 can therefore determine the location of the vehicle, static buildings, and dynamic objects, which can enable the vehicle to change the navigation route, speed, acceleration, vehicle alarm system, and / or other functions accordingly. Autonomous control 840 can therefore implement various functions of the intelligent transportation system, such as autonomous driving, semi-autonomous driving, navigation, etc.
[0122] The communication interface 850 provides an interface that allows data to communicate with a network, a vehicle, a positioning server, a server, a wireless access point, other computer systems, and / or any other electronic device described herein. In some embodiments, the communication interface 850 may include, but is not limited to, a modem, a network card, an infrared communication device, a wireless communication device, and / or a chipset (e.g., a Bluetooth device, an IEEE 802.11 device, an IEEE 802.15.4 device, a WIFI device, a WiMAX device, a cellular communication facility, etc.), etc.
[0123] This system diagram is intended to provide a general description of 3D LiDAR-assisted GNSS, and other components and system blocks may be included as needed. One or more components within the system may be integrated or partitioned and may be arranged in different physical locations in the vehicle or otherwise remotely arranged in a server or on a network system. An override control (not shown) or other safety mechanism may also be provided to allow the driver or passenger of the vehicle to take over control of the vehicle in an emergency.
[0124] As demonstrated, the method of the present disclosure provides an effective way to exclude potential GNSS NLOS receptions, with the help of environmental descriptions generated by 3D LiDAR sensors and LIO, or SWM using 3D LiDAR sensors and AHRS. The method can achieve accurate positioning even in urban canyons for autonomous driving. The present invention solves the problem that insufficient positioning accuracy hinders the deployment of autonomous driving applications. On top of all these existing positioning solutions, GNSS-RTK is an indispensable method that can provide global reference positioning in sparse scenes. However, due to signal occlusion and reflection leading to GNSS NLOS reception, its accuracy cannot be guaranteed in urban canyons. The present disclosure solves this problem by leveraging the perception capabilities of 3D LiDAR to detect and eliminate potential GNSS NLOS receptions. In some embodiments, the method provided herein can achieve higher accuracy even in urban canyon scenarios to meet the navigation requirements of autonomous driving.
[0125] The above method can be directly applied to the autonomous driving industry. Specifically, the present invention can be used to provide accurate positioning solutions even in urban canyons. In addition, the method can also be applied to other autonomous systems with navigation needs, such as mobile robots and drones. At the same time, the method can also be used for geodetic mapping of urban canyons. This illustrates a 3D LiDAR-assisted global navigation satellite system with improved positioning performance according to the present disclosure. Obviously, the variants and other features and functions disclosed above or their alternatives can be combined into many other different configurations, devices, apparatuses and systems. Therefore, the present embodiment is considered to be illustrative and not restrictive in all respects. The scope of the present disclosure is indicated by the appended claims rather than by the foregoing description, and is intended to include all changes that fall within the equivalent meaning and scope of the claims.
[0126] List of abbreviations
[0127] 3D
[0128] 3DMA 3D map construction assistance
[0129] ADAS Advanced Driver Assistance System
[0130] ADV Autonomous Driving Vehicle
[0131] AHRS Attitude Heading Reference System
[0132] DOP Dilution of Precision
[0133] ECEF Earth-centered Earth-fixed coordinate system
[0134] ENU Northeast Sky
[0135] FOV Field of View
[0136] GNSS Global Navigation Satellite System
[0137] GNSS-RTK Global Navigation Satellite System Real-Time Kinematic Differential Positioning
[0138] GPS Global Positioning System
[0139] LiDAR Light Detection and Ranging (LiDAR)
[0140] LIO LiDAR-Inertial Odometry
[0141] IMU Inertial Measurement Unit
[0142] LOS Line of Sight
[0143] NLOS Non Line of Sight
[0144] PCM Point Cloud Map
[0145] ROS Robot Operating System
[0146] RTK Real-time dynamic differential positioning
[0147] SLAM Simultaneous Localization and Mapping
[0148] SWM Sliding Window Map
[0149] t GNSS epoch
[0150] G ECEF coordinate system
[0151] LENU coordinate system
[0152] s Satellite index
[0153] GNSS receiver
[0154] BI AHRS carrier coordinate system
[0155] BL LiDAR carrier coordinate system
[0156] BR GNSS receiver carrier coordinate system
[0157] ρ Pseudorange
[0158] Pseudorange of the satellite at epoch t
[0159] The position of the satellite at epoch t
[0160] The position of the satellite GNSS receiver at epoch t
[0161] δ r,t GNSS receiver clock error
[0162] Satellite clock error
[0163] Signal-to-Noise Ratio (SNR)
[0164] K w Scaling factor used for weighting
[0165] Satellite elevation angle
[0166] Satellite azimuth
[0167] k Search point index
[0168] N k Number of adjacent points
Claims
1. A method for use by a vehicle for supporting positioning of the vehicle using a satellite positioning system, the method comprising: Generating a sliding window map SWM in real time based on a 3D point cloud from a 3D LiDAR sensor and an attitude and heading reference system AHRS, wherein the SWM provides an environment description for detecting and correcting non-line-of-sight NLOS reception; Minimizing the point cloud capacity of the SWM by excluding point clouds far from the GNSS receiver so that the 3D point cloud is within the sliding window; Accumulating 3D point clouds from previous frames into the SWM to enhance the field of view (FOV) of the 3D LiDAR sensor; receiving, via a GNSS receiver, Global Navigation Satellite System (GNSS) measurements from a satellite; detecting the NLOS reception from the GNSS measurements using the SWM; When no reflection point can be found in the SWM, correcting the NLOS reception by NLOS reconstruction; and Estimate GNSS positioning through the least squares algorithm; The NLOS reconstruction is performed using a weighting scheme having a scaling factor for de-weighting the NLOS reception, the weighting scheme comprising the following definitions: If the satellite is classified as a LOS measurement, the scaling factor is calculated based on the satellite signal-to-noise ratio SNR and the elevation angle; If the satellite is classified as a NLOS measurement and the pseudorange error is corrected, calculating the scaling factor based on the satellite SNR and the elevation angle; and If the satellite is classified as a NLOS measurement but no reflection point is detected, then the satellite SNR, the elevation angle and the scaling factor The scaling factor is calculated.
2. The method of claim 1, wherein: The steps of generating the SWM include: Based on the 3D point cloud from the 3D LiDAR sensor, obtaining a local map from LiDAR scan matching; and The SWM is transformed from the vehicle coordinate system to the local northeast ENU coordinate system using the direction of the AHRS.
3. The method of claim 1, wherein: The step of detecting the NLOS reception from the GNSS measurements is performed using a fast search method, wherein the fast search method comprises: Initializing a search point for a center of the 3D LiDAR sensor; Determining a search direction connecting the GNSS receiver and the satellite according to the elevation angle and the azimuth angle of the satellite; In fixed increments moving the search point along the search direction; Calculate the neighboring points near the search point Quantity; and if Exceeding a predetermined threshold , the search point is classified as a NLOS satellite.
4. The method of claim 1, further comprising: The NLOS reception is corrected by re-estimating the GNSS measurements using a model calibration based on the SWM, wherein the SWM provides a dense, discrete and unorganized 3D point cloud without continuous building surfaces or boundaries.
5. The method according to claim 4, wherein: The model calibration includes: Using an efficient reflector-based detection algorithm kdTree The structure detects the reflection point corresponding to the NLOS reception, wherein the reflector detection algorithm includes: Traversal from 0 o To 360 o For all azimuths, the azimuth resolution is , the elevation angle is ; When the connection point Detect potential reflectors when line of sight to the satellite is not obstructed; and A unique reflector having a shortest distance between the GNSS receiver and the potential reflectors is detected.
6. A LiDAR-assisted global navigation satellite system for use by a vehicle to support positioning of the vehicle using a satellite positioning system, the system comprising: 3D LiDAR sensor; Attitude and Heading Reference System AHRS; a Global Navigation Satellite System (GNSS) receiver configured to receive GNSS measurements from a satellite; a processor communicatively connected to the 3D LiDAR sensor, the AHRS, and the GNSS receiver, wherein the processor is configured to: Generating a sliding window map (SWM) in real time based on the 3D point cloud from the 3D LiDAR sensor and the AHRS, wherein the SWM provides an environmental description for detecting and correcting non-line-of-sight (NLOS) reception; minimizing the point cloud capacity of the SWM by excluding point clouds far from the GNSS receiver so that the 3D point cloud is within a sliding window; Accumulating 3D point clouds from previous frames into the SWM to enhance the field of view (FOV) of the 3D LiDAR sensor; detecting NLOS reception from the GNSS measurements of the GNSS receiver using the SWM; When no reflection point is found in the SWM, correcting the NLOS reception by NLOS reconstruction; and Estimate GNSS positioning through the least squares algorithm; The NLOS reconstruction is performed using a weighting scheme having a scaling factor for de-weighting the NLOS reception, the weighting scheme comprising the following definitions: If the satellite is classified as a LOS measurement, the scaling factor is calculated based on the satellite signal-to-noise ratio SNR and the elevation angle; If the satellite is classified as a NLOS measurement and the pseudorange error is corrected, calculating the scaling factor based on the satellite SNR and the elevation angle; and If the satellite is classified as a NLOS measurement but no reflection point is detected, then the satellite SNR, the elevation angle and the scaling factor The scaling factor is calculated.
7. The system according to claim 6, wherein: The processor is configured to obtain a local map based on the 3D point cloud from the 3D LiDAR sensor; and transform the SWM from a carrier coordinate system to a local Northeastern Heaven (ENU) coordinate system using the direction of the AHRS.
8. The system according to claim 6, wherein: The processor is configured to detect the non-line-of-sight reception from the GNSS measurements using a fast search method, wherein the fast search method comprises: Initializing a search point for a center of the 3D LiDAR sensor; Determining a search direction connecting the GNSS receiver and the satellite according to the elevation angle and the azimuth angle of the satellite; In fixed increments moving the search point along the search direction; Calculate the neighboring points near the search point Quantity; and if Exceeding a predetermined threshold , the search point is classified as a NLOS satellite.
9. The system according to claim 6, wherein: The processor is further configured to correct the NLOS reception by re-estimating the GNSS measurements using a model calibration based on the SWM, wherein the SWM provides a dense, discrete, and unorganized 3D point cloud without continuous building surfaces or boundaries.
10. The system according to claim 9, wherein: The model calibration includes: Using an efficient reflector-based detection algorithm kdTree The structure detects the reflection point corresponding to the NLOS reception, wherein the reflector detection algorithm includes: Traversal from 0 o To 360 o For all azimuths, the azimuth resolution is , the elevation angle is ; When the connection point Detect potential reflectors when line of sight to the satellite is not obstructed; and A unique reflector having a shortest distance between the GNSS receiver and the potential reflectors is detected.
11. The system of claim 6, further comprising: Autonomous vehicle control based on the GNSS positioning to realize various functions of the intelligent transportation system; a user interface for activating or deactivating said autonomous control; as well as Communication interface.
Citation Information
Patent Citations
Positioning and mapping method and system based on fusion of laser radar and inertial measurement unit
CN113066105A