A satellite navigation positioning method and system assisted by inertial navigation
By using inertial navigation-assisted satellite positioning and navigation methods in the vehicle positioning system, the reflected cube collects scene objects, correcting satellite signals, solving the problem of low positioning accuracy in complex scenarios, and improving positioning accuracy and computing efficiency .
Patent Information
- Application Number
- CN202211205377.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-09-30
- Publication Date
- 2024-11-29
- Estimated Expiration
- 2042-09-30
AI Technical Summary
In special scenarios such as high-precision positioning systems in urban high-precision positioning systems, GNSS is affected by multi-path errors, resulting in low positioning accuracy, affecting the performance of advanced assisted driving and autonomous driving.
Using inertial navigation-assisted satellite positioning and navigation methods, the objects that affect reflected waves around the map navigation terminal are obtained by reflecting cubes to collect scene objects, and the satellite signals are corrected to improve positioning accuracy.
The calculation amount of the server's calculation of reflected waves affecting the object, improves the calculation efficiency of satellite navigation positioning, and enhances the positioning accuracy, especially in complex scenarios.
Smart Images

Figure CN115451956B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of high-precision positioning technology, and more specifically, to an inertial navigation-assisted satellite positioning and navigation system. Background Art
[0002] With the continuous improvement of science and technology in recent years, artificial intelligence has developed rapidly and has been widely used in various fields. Among them, since autonomous driving vehicles can efficiently use traffic resources, alleviate traffic congestion and reduce carbon emissions, autonomous driving technology has become more and more the focus of people's attention. Advanced assisted driving has already entered the mass production and commercialization stage, especially new energy vehicles, which can realize navigation assistance on highways and even urban roads.
[0003] High-precision positioning technology is one of the key technologies for achieving advanced driver assistance and autonomous driving, and is also a basic technology. It also affects the performance of modules such as high-precision maps and perception recognition. The current vehicle-mounted high-precision positioning system mainly relies on the Global Navigation Satellite System (GNSS) technology and the Inertial Navigation System (INS) technology.
[0004] GNSS only provides high-precision positioning information in open environments. When the satellite signal is blocked, the positioning error is large or even impossible. INS obtains current position information through internal inertial devices (gyroscopes, accelerometers); INS is sealed and does not need to communicate with the outside world, so it has strong independence; the disadvantage of INS is that as navigation continues, inertial navigation will deviate, which is caused by temperature changes and vibrations, but the deviation can be compensated through algorithms.
[0005] However, in actual applications, GNSS provides absolute positioning values in most scenarios, and its accuracy and reliability seriously affect the realization of advanced assisted driving performance, especially in special scenarios such as urban high-rise buildings or tree-lined roads. GNSS is affected by multipath errors, resulting in serious discrepancies between its own predicted positioning state and the actual positioning accuracy, which in turn affects the output accuracy of the entire multi-sensor fusion positioning system.
[0006] Therefore, the problems existing in the prior art need to be further improved and developed. Summary of the invention
[0007] (I) Purpose of the invention: In order to solve the problems existing in the above-mentioned prior art, the purpose of the present invention is to provide an inertial navigation-assisted satellite positioning method and system with higher positioning accuracy.
[0008] (II) Technical solution: In order to solve the above technical problems, the present technical solution provides an inertial navigation-assisted satellite positioning and navigation method, using a map navigation terminal, which includes the following steps:
[0009] Step 1: receiving a first positioning signal for the map navigation terminal at the first time, wherein the first positioning signal is a combined signal after interference between a direct wave and a reflected wave in a satellite signal;
[0010] Step 2: according to the first positioning signal received at the first time, a first positioning location corresponding to the first positioning signal and scene information in a reflection cube including the first positioning location are obtained; according to the scene object included in the scene information in the reflection cube and a reflection coefficient table of the scene object, the first positioning signal is corrected to obtain a second positioning signal;
[0011] Step three, perform inertial navigation solution on the map navigation terminal at the first time, output the three-dimensional posture, position and speed information of the map navigation terminal in real time, and correct the second positioning signal according to the settlement result of inertial navigation to obtain the final positioning signal.
[0012] The inertial navigation-assisted satellite positioning and navigation method, wherein the reflection cube is used to determine the location of scene objects that contribute to the reflected waves in the satellite signal, is a spatial range centered on the map navigation terminal, with the left and right spacing being the first threshold, the front and back spacing being the second threshold, and the top and bottom spacing being the third threshold.
[0013] The inertial navigation-assisted satellite positioning and navigation method, wherein the first threshold, the second threshold and the third threshold are dynamically adjusted according to the distance of the obstacle identified by the laser reflection signal; if the obstacle distance is less than the corresponding threshold, the corresponding threshold is replaced by the obstacle distance, including the first threshold, the second threshold or the third threshold.
[0014] In the inertial navigation-assisted satellite positioning and navigation method, the map information displayed by the map information unit includes: navigation data of the map navigation terminal, scene information matching the navigation data and stored in the server, and scene object data corresponding to the scene information.
[0015] In the inertial navigation-assisted satellite positioning and navigation method, the scene information of the server that matches the navigation data includes: a navigation map, which is divided into map grids, and real-world scene objects are distributed on the navigation map.
[0016] In the inertial navigation-assisted satellite positioning and navigation method, the scene object has an independent identifier, and the identifier of the scene object and the identifier of the map grid are bound.
[0017] In the inertial navigation-assisted satellite positioning and navigation method, the reflection coefficient table of the scene object is stored in a map navigation terminal or a server.
[0018] The inertial navigation-assisted satellite positioning and navigation method, wherein the server locates the map grid covering the reflection cube corresponding to the position information of the reflection cube, and sends the scene objects and / or scene object reflection coefficients within the located map grid to the map navigation terminal.
[0019] An inertial navigation-assisted satellite positioning and navigation system includes a map navigation terminal and a server, wherein the map navigation terminal includes a map information unit, a satellite navigation unit and an inertial navigation unit, wherein:
[0020] The satellite navigation unit receives a first positioning signal for the map navigation terminal at a first time, wherein the first positioning signal is a combined signal after interference between a direct wave and a reflected wave in the satellite signal;
[0021] The map information unit receives a first positioning signal at a first time, obtains a first positioning location corresponding to the first positioning signal, and scene information in a reflection cube including the first positioning location; corrects the first positioning signal according to a scene object included in the scene information in the reflection cube and a reflection coefficient table of the scene object to obtain a second positioning signal;
[0022] The inertial navigation unit performs inertial navigation solution on the map navigation terminal at the first time, outputs the three-dimensional posture, position and speed information of the map navigation terminal in real time, and corrects the second positioning signal to obtain a final positioning signal.
[0023] (III) Beneficial effects: The present invention provides an inertial navigation-assisted satellite positioning and navigation method and system, which firstly uses a reflection cube to collect scene objects, and obtains objects around the map navigation terminal that affect the reflected waves. This can reduce the amount of calculation of the server for calculating the objects affected by the reflected waves, and improve the calculation efficiency of satellite navigation positioning. BRIEF DESCRIPTION OF THE DRAWINGS
[0024] Figure 1 It is a schematic flow chart of the inertial navigation-assisted satellite positioning and navigation method of the present invention;
[0025] Figure 2 It is a structural schematic diagram of the inertial navigation-assisted satellite positioning and navigation system of the present invention. DETAILED DESCRIPTION
[0026] The present invention is further described in detail below in conjunction with preferred embodiments. More details are elaborated in the following description to facilitate a full understanding of the present invention. However, the present invention can obviously be implemented in a variety of other ways different from the description. Those skilled in the art can make similar generalizations and deductions based on actual application situations without violating the connotation of the present invention. Therefore, the protection scope of the present invention should not be limited by the content of this specific embodiment.
[0027] The accompanying drawings are schematic diagrams of embodiments of the present invention. It should be noted that the drawings are only examples and are not drawn to scale, and should not be used to limit the actual protection scope of the present invention.
[0028] The present invention provides an inertial navigation-assisted satellite positioning and navigation method, such as Figure 1 As shown, the application map navigation terminal includes the following steps:
[0029] Step 1: receiving a first positioning signal for the map navigation terminal at the first time, wherein the first positioning signal is a combined signal after interference between a direct wave and a reflected wave in a satellite signal;
[0030] Step 2: according to the first positioning signal received at the first time, a first positioning location corresponding to the first positioning signal and scene information in a reflection cube including the first positioning location are obtained; according to the scene object included in the scene information in the reflection cube and a reflection coefficient table of the scene object, the first positioning signal is corrected to obtain a second positioning signal;
[0031] Step three, perform inertial navigation solution on the map navigation terminal at the first time, output the three-dimensional posture, position and speed information of the map navigation terminal in real time, and correct the second positioning signal according to the settlement result of inertial navigation to obtain the final positioning signal.
[0032] The map navigation terminal of the inertial navigation-assisted satellite positioning and navigation method of the present invention preferably includes a map information unit, a satellite navigation unit and an inertial navigation unit, and includes the following steps:
[0033] Step 201: The satellite navigation unit receives a first satellite navigation signal to a map navigation terminal at a first time, wherein the first positioning signal is a combined signal of interference between a direct wave and a reflected wave in the satellite signal.
[0034] In step 202, the map information unit receives a first positioning signal at a first time, obtains a first positioning location corresponding to the first positioning signal, and scene information in a reflection cube including the first positioning location; and corrects the first positioning signal according to scene objects included in the scene information in the reflection cube and a reflection coefficient table of the scene objects to obtain a second positioning signal.
[0035] In step 203, the inertial navigation unit performs inertial navigation solution on the map navigation terminal at the first time, outputs the three-dimensional posture, position and speed information of the map navigation terminal in real time, and corrects the second positioning signal at the corresponding time according to the inertial measurement value calculated by the inertial navigation unit to obtain the final positioning signal.
[0036] The map navigation terminal may be an unmanned car, an unmanned aircraft, a car that needs navigation, or other terminals that need map navigation, and the specific terminal is not limited.
[0037] The reflection cube is a spatial range that affects the positioning of the map navigation terminal. The present invention is set to a spatial range with the map navigation terminal as the center, the left and right spacing is the first threshold, the front and back spacing is the second threshold, and the upper and lower spacing is the third threshold. The present invention is preferred, and the first threshold, the second threshold and the third threshold can be within the range of 15 meters, and can also be adjusted according to specific circumstances. The reflection cube is used to determine the location of scene objects that contribute to the reflected waves in the satellite signal. The first threshold, the second threshold and the third threshold can also be dynamically adjusted according to the obstacle distance identified by the laser reflection signal. The first threshold, the second threshold and the third threshold are determined and adjusted according to the obstacle distance to obtain a reflection cube of dynamic size. If the obstacle distance is less than the corresponding threshold, the obstacle distance can be used to replace the corresponding threshold, including the first threshold, the second threshold or the third threshold.
[0038] The map information displayed by the map information unit of the present invention includes: navigation data of the map navigation terminal, scene information matching the navigation data stored in the server, and scene object data corresponding to the scene information. The navigation data of the map information includes: current location information, key location information, navigation route, landmark information, etc. The scene information of the server matching the navigation data includes: a navigation map, which divides the navigation map into map grids, and real-world scene objects are distributed on the navigation map, including buildings, trees, rivers, rice fields, etc. The scene object can be a real-life picture after field observation, or a three-dimensional stereogram presented by AI automatic modeling, which is not limited here. The map grid can preferably be set to 10m*10m, divided according to the accuracy of satellite navigation positioning, which is not limited here. The scene object has an independent identifier, and the identifier of the scene object is bound to the identifier of the map grid, for example:
[0039]
[0040] The amount of data of the scene objects contained in the scene information is very large. Dividing the navigation map into map grids helps to reduce the data transmission between the map navigation terminal and the server. The detailed implementation example is as follows:
[0041] In step 2, the server locates the map grid covering the reflection cube according to the position information of the reflection cube, and sends the scene object and / or the reflection coefficient of the scene object in the located map grid to the map navigation terminal. The reflection coefficient table of the scene object is represented by α; α=0 means that the signal is completely absorbed and not reflected; α=1 means that the signal is completely transmitted and not absorbed.
[0042] Some examples of reflection coefficient tables are as follows:
[0043]
[0044] The present invention takes into account the influence of weather temperature on the reflection coefficient, and sets an influence factor in the reflection coefficient table to adjust the reflection coefficient of the scene object according to the weather temperature. The reflection coefficient influence factor table of the present invention is preferably stored in the map navigation terminal, and a partial reflection coefficient influence factor table is as follows:
[0045]
[0046]
[0047] The map navigation terminal of the present invention has a weather acquisition module for acquiring weather information such as the temperature and light of the scene that affects the satellite positioning signal. The weather acquisition module is associated with a reflection coefficient influencing factor table; a coefficient adjustment module is set in the reflection coefficient table, and the coefficient adjustment module adds an influencing factor to the reflection coefficient of the scene object in the reflection coefficient table according to the weather conditions of the scene.
[0048] The correction calculation of the first positioning signal of the present invention requires determining the scene object of the reflection of the first positioning signal in the reflection cube, as well as the reflection coefficient and influence factor of the scene object, and performing correction calculation on the first positioning signal based on the reflection coefficient and influence factor to improve the positioning accuracy.
[0049] For example, the location of the map navigation terminal is on a bridge, with a cliff on one side and a reservoir on the other. The map information unit can identify the distance of the obstacle cliff based on the laser reflection signal, thereby optimizing the range of the reflection cube, and obtaining the scene objects, cliffs and reservoirs contained in the reflection cube from the server according to the value of the optimized reflection cube, thereby obtaining the reflection coefficients of the cliff and reservoir. The map navigation terminal also obtains the surrounding temperature exceeding 38°C through the weather acquisition module, which is a high temperature weather. At this time, the surrounding environmental factors will have a huge impact on the reflection coefficient. Therefore, the map navigation terminal will associate the reflection coefficient influencing factor table to obtain the corresponding influencing factors of the cliff and reservoir.
[0050] The direct wave signal expression is: U is the signal voltage, w is the angular frequency of the carrier;
[0051] S d =Ucosωt
[0052] The expression of the reflection signal is:
[0053] S r =αδUcos(ωt+θ)
[0054] U is the amplitude of the direct signal, ω is the angular frequency of the carrier satellite, θ is the phase delay of the reflected signal, and α is the reflection coefficient of the object. Since the satellite receives the superposition signal of the reflected signal and the direct signal, the signal actually received by the antenna is:
[0055]
[0056] β and φ are:
[0057] β=(1+2αcosθ+α 2 ) 1 / 2
[0058]
[0059] φ is the multipath error. When multiple reflected signals enter the receiver antenna at the same time, the multipath error is:
[0060]
[0061] According to the above steps, the first positioning signal is corrected by the reflection coefficient and the reflection coefficient factor to obtain the second positioning signal.
[0062] The present invention provides an inertial navigation-assisted satellite positioning and navigation method and system, which need to strictly judge the reliability of the current satellite navigation positioning value, obtain the first positioning signal using traditional multi-epoch observation under static conditions, and increase the elevation angle threshold of the navigation satellite participating in the positioning to 45° (usually the satellite navigation uses 0° or 15° as the threshold value), while ensuring that the number of currently participating satellites is not less than 12, and the differential positioning state is a fixed solution.
[0063] The present invention uses the positioning value and direction-finding value when the satellite navigation is stationary to initialize the current inertial navigation system, and completes the initial alignment and initial position assignment; the inertial navigation unit can collect signals at the same frequency as the satellite navigation unit, and the signal collection of the inertial navigation unit can be time-synchronized with the satellite navigation unit, that is, the inertial navigation unit and the satellite navigation unit both collect signals at the first time to improve the accuracy of the positioning signal. After the satellite navigation system calculates the first positioning signal, the calculation result calculated by the inertial navigation unit at the first time is used to correct the first positioning signal of the satellite navigation unit to obtain a more accurate final positioning signal.
[0064] The present invention provides an inertial navigation-assisted satellite positioning and navigation method and system, including an application map navigation terminal and a server, wherein the map navigation terminal includes a map information unit, a satellite navigation unit and an inertial navigation unit. The satellite navigation unit receives a first positioning signal for the map navigation terminal at a first time, and the first positioning signal is a combined signal after interference between a direct wave and a reflected wave in the satellite signal. The map information unit obtains a first positioning location corresponding to the first positioning signal and scene information in a reflection cube containing the first positioning location according to the first positioning signal received at the first time; the first positioning signal is corrected according to the scene object contained in the scene information in the reflection cube and the reflection coefficient table of the scene object to obtain a second positioning signal. The inertial navigation unit performs inertial navigation solution on the map navigation terminal at the first time, outputs the three-dimensional posture, position and speed information of the map navigation terminal in real time, and corrects the second positioning signal to obtain a final positioning signal.
[0065] The present invention provides an inertial navigation-assisted satellite positioning and navigation method and system, which firstly uses a reflection cube to collect scene objects to obtain objects that affect the reflected waves around the map navigation terminal, thereby reducing the amount of calculation of the server to calculate the objects that affect the reflected waves and improving the calculation efficiency. The present invention also considers that the surrounding environmental factors will have a huge impact on the reflection coefficient, and therefore introduces a reflection coefficient influencing factor, so that the present invention makes the correction result of the first positioning signal more accurate and the obtained positioning signal more precise.
[0066] The above content is an explanation of the preferred embodiments of the present invention, which can help those skilled in the art to more fully understand the technical solution of the present invention. However, these embodiments are merely illustrative, and it cannot be determined that the specific implementation methods of the present invention are limited to the description of these embodiments. For ordinary technicians in the technical field to which the present invention belongs, without departing from the concept of the present invention, several simple deductions and transformations can be made, which should be regarded as belonging to the protection scope of the present invention.
Claims
1. An inertial navigation-assisted satellite positioning and navigation method, using a map navigation terminal, characterized in that: The following steps are included: Step 1: receiving a first positioning signal for the map navigation terminal at the first time, wherein the first positioning signal is a combined signal after interference between a direct wave and a reflected wave in a satellite signal; Step 2: according to the first positioning signal received at the first time, a first positioning location corresponding to the first positioning signal and scene information in a reflection cube including the first positioning location are obtained; according to the scene object included in the scene information in the reflection cube and the reflection coefficient table of the scene object, the first positioning signal is corrected to obtain a second positioning signal; Step three, performing inertial navigation calculation on the map navigation terminal at the first time, outputting the three-dimensional attitude, position and speed information of the map navigation terminal in real time, and correcting the second positioning signal according to the settlement result of the inertial navigation to obtain the final positioning signal; The reflection cube is used to determine the location of scene objects that contribute to the reflected waves in the satellite signal. It is a spatial range centered on the map navigation terminal, with the left and right spacing being the first threshold, the front and back spacing being the second threshold, and the upper and lower spacing being the third threshold. The first threshold, the second threshold, and the third threshold are dynamically adjusted according to the distance of the obstacle identified by the laser reflection signal; if the obstacle distance is less than the corresponding threshold, the obstacle distance is used to replace the corresponding threshold, including the first threshold, the second threshold, or the third threshold.
2. The inertial navigation-assisted satellite positioning and navigation method according to claim 1, characterized in that: The map information displayed by the map information unit includes: navigation data of the map navigation terminal, scene information matching the navigation data and stored in the server, and scene object data corresponding to the scene information.
3. The inertial navigation-assisted satellite positioning and navigation method according to claim 2, characterized in that: The scene information of the server that matches the navigation data includes: a navigation map, which is divided into map grids, and scene objects of the real world are distributed on the navigation map.
4. The inertial navigation-assisted satellite positioning and navigation method according to claim 3, characterized in that: The scene object has an independent identifier, and the identifier of the scene object and the identifier of the map grid are bound.
5. The inertial navigation-assisted satellite positioning and navigation method according to claim 1, characterized in that ,The reflection coefficient table of the scene object is stored in the map navigation terminal or server.
6. The inertial navigation-assisted satellite positioning and navigation method according to claim 5, characterized in that: The server locates the map grid covering the reflection cube according to the position information of the reflection cube, and sends the scene objects and / or the reflection coefficients of the scene objects in the located map grid to the map navigation terminal.
7. An inertial navigation-assisted satellite positioning and navigation system, comprising a map navigation terminal and a server, wherein the map navigation terminal comprises a map information unit, a satellite navigation unit and an inertial navigation unit, characterized in that: The satellite navigation unit receives a first positioning signal for the map navigation terminal at a first time, wherein the first positioning signal is a combined signal after interference between a direct wave and a reflected wave in the satellite signal; The map information unit receives a first positioning signal at a first time, obtains a first positioning location corresponding to the first positioning signal, and scene information in a reflection cube including the first positioning location; corrects the first positioning signal according to a scene object included in the scene information in the reflection cube and a reflection coefficient table of the scene object to obtain a second positioning signal; The inertial navigation unit performs inertial navigation calculation on the map navigation terminal at the first time, outputs the three-dimensional posture, position and speed information of the map navigation terminal in real time, and corrects the second positioning signal to obtain a final positioning signal; The reflection cube is used to determine the location of scene objects that contribute to the reflected waves in the satellite signal. It is a spatial range centered on the map navigation terminal, with the left and right spacing being the first threshold, the front and back spacing being the second threshold, and the upper and lower spacing being the third threshold. The first threshold, the second threshold, and the third threshold are dynamically adjusted according to the distance of the obstacle identified by the laser reflection signal; if the obstacle distance is less than the corresponding threshold, the obstacle distance is used to replace the corresponding threshold, including the first threshold, the second threshold, or the third threshold.
Citation Information
Patent Citations
Inertial navigation and satellite navigation tight combination satellite navigation positioning method and system
CN115451957A
