Positioning method, device, equipment and program
Combining radar point cloud data with satellite observation data enhances positioning accuracy and robustness for mobile devices, addressing limitations in existing satellite-dependent methods.
Patent Information
- Application Number
- JP2024532222
- Authority / Receiving Office
- JP · JP
- Patent Type
- Applications
- Current Assignee / Owner
- Priority Date
- 2022-06-09
- Filing Date
- 2023-04-10
- Publication Date
- 2024-11-26
- Estimated Expiration
- 2043-04-10
AI Technical Summary
Existing positioning methods for mobile devices rely solely on satellite observation data, which limits accuracy and robustness, leading to potential inaccuracies and low robustness when data quality is poor.
A positioning method that combines point cloud data from a radar attached to a mobile device with satellite observation data to obtain a target positioning result, reducing dependence on either data source and incorporating complementary information to enhance accuracy and robustness.
This approach improves positioning accuracy and robustness by leveraging both point cloud and satellite data, ensuring reliable positioning even when individual data quality is poor.
Smart Images

Figure 2024543946000001_ABST
Abstract
Description
[Technical field]
[0001] This application claims priority to a Chinese patent application with application number 202210653933.5, filed on June 9, 2022, for the invention titled "Positioning method, device, equipment, and storage medium", the entire contents of which are incorporated herein by reference. TECHNICAL FIELD The present disclosure relates to the technical field of navigation, and in particular to a positioning method, device, equipment, and storage medium. [Background technology]
[0002] As navigation technology advances, the number of application scenarios requiring the positioning of mobile devices is increasing. For example, in delivery scenarios, the position of the terminal to be delivered needs to be determined, and in autonomous driving scenarios, the position of the in-vehicle terminal needs to be determined.
[0003] In a related technique, a satellite positioning device attached to a mobile device calculates a positioning result of the mobile device in real time based on observation data received. Summary of the Invention [Problem to be solved by the invention]
[0004] The embodiments of the present application provide a positioning method, an apparatus, a device, and a storage medium, which can improve positioning accuracy and positioning robustness. [Means for solving the problem]
[0005] According to one aspect, a method for positioning performed by a computing device according to an embodiment of the present application includes: acquiring point cloud data scanned by a radar attached to a mobile device, and positioning the mobile device using the point cloud data to obtain a first positioning result; acquiring first observation data received by a satellite positioning device attached to the mobile device; and obtaining a target positioning result for the mobile device based on the first observation data and the first positioning result.
[0006] According to another aspect, the positioning device comprises: A first acquisition unit that acquires point cloud data scanned by a radar attached to a mobile device; a positioning unit that uses the point cloud data to position the mobile device and obtain a first positioning result; a second acquisition unit for acquiring first observation data received by a satellite positioning device attached to the mobile device; and a third acquisition unit for acquiring a target positioning result of the mobile device based on the first observation data and the first positioning result.
[0007] According to another aspect, a computing device includes a processor and a memory having stored therein at least one computer program which, when loaded and executed by the processor, causes the computing device to implement any of the positioning methods described above.
[0008] According to yet another aspect, a non-volatile computer readable storage medium has stored thereon at least one computer program which, when loaded and executed by a processor, causes the computer to implement any of the positioning methods described above.
[0009] According to yet another aspect, a computer program product comprises a computer program or computer instructions which, when loaded and executed by a processor, causes a computer to implement any of the positioning methods described above.
[0010] According to another aspect, a computer program comprises computer instructions which, when loaded and executed by a processor, cause the computer to implement any of the positioning methods described above. Effect of the Invention
[0011] According to the technical means of the embodiments of the present application, the final target positioning result of the mobile device is obtained by comprehensively taking into consideration the point cloud data scanned by the radar installed on the mobile device and the first observation data received by the satellite positioning device, and the point cloud data and the first observation data can complement each other. Such a positioning method can reduce the dependency on any one of the point cloud data and the first observation data. Even if the quality of the point cloud data or the first observation data is poor, a more accurate target positioning result can be obtained by additionally taking into consideration the other data, which is highly robust and advantageous for meeting actual positioning needs. [Brief description of the drawings]
[0012] [Figure 1] This is a comparison diagram of the effectiveness of standalone positioning and RTK differential positioning. [Diagram 2] 1 is a schematic diagram of an implementation environment of a positioning method according to an embodiment of the present application; [Diagram 3] 1 is a flowchart of a positioning method according to an embodiment of the present application; [Figure 4] FIG. 2 is a schematic diagram of a process for positioning a mobile device using point cloud data and obtaining a first positioning result according to an embodiment of the present application. [Diagram 5] 13 is a flowchart of an implementation process of obtaining a target positioning result based on a first positioning result according to target data according to an embodiment of the present application; [Figure 6] FIG. 2 is a schematic diagram of a related treatment process of a first filter according to an embodiment of the present application. [Figure 7] 13 is a flowchart of an implementation process of obtaining a target positioning result based on a first positioning result according to target data according to an embodiment of the present application; [Figure 8] FIG. 2 is a schematic diagram of a process for decomposing state parameters of a mobile device based on first observation data according to an embodiment of the present application; [Figure 9] FIG. 2 is a schematic diagram of a process for estimating a mobile device's location and clock bias using a robust weighted least squares method, according to an embodiment of the present application; [Figure 10] FIG. 2 is a schematic diagram of a process for estimating the velocity and clock drift of a mobile device using a robust weighted least squares method according to an embodiment of the present application; [Figure 11] FIG. 1 is a block schematic diagram of a positioning method according to an embodiment of the present application; [Figure 12] FIG. 2 is a schematic diagram of a detailed process of a positioning method according to an embodiment of the present application; [Figure 13] 1 is a schematic diagram of an application scene of a positioning method according to an embodiment of the present application; [Figure 14] 1 is a schematic diagram of an application scene of a positioning method according to an embodiment of the present application; [Figure 15] 1 is a schematic diagram of a positioning device according to an embodiment of the present application; [Figure 16] FIG. 1 is a schematic diagram illustrating a configuration of a mobile device according to an embodiment of the present application. [Figure 17] FIG. 2 is a schematic configuration diagram of a server according to an embodiment of the present application. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0013] In order to make the objectives, technical means and advantages of the present application clearer, the embodiments of the present application are described in more detail below with reference to the drawings.
[0014] Some nouns related to the embodiments of the present application will be explained below.
[0015] Global Navigation Satellite System (GNSS), also called Global Navigation Satellite System, is a space-based radio navigation positioning system that can provide users with all-weather three-dimensional coordinates, speed and time information anywhere on the Earth's surface or near-Earth space. There are four common global satellite positioning systems: Global Positioning System (GPS), BeiDou Navigation Satellite System (BDS), GLONASS and Galileo. GPS was developed the earliest and is also the one with relatively complete technology. In recent years, with BDS and GLONASS providing comprehensive services in some areas, BDS in particular has been developing more and more rapidly in the civilian field. Global satellite positioning systems are widely used in communication, positioning, consumer entertainment, surveying, vehicle management, car navigation and information services.
[0016] A satellite positioning device (also called a satellite signal receiver) is an electronic device that receives and processes satellite signals to measure the geometric distance between a mobile device and a satellite (pseudo-range observation) and the Doppler effect of the satellite signal (Doppler observation). A satellite positioning device usually includes modules such as an antenna, a satellite signal receiving loop, and baseband signal processing. A mobile device integrated with a satellite positioning device calculates the current position coordinates of the mobile device based on the pseudo-range observation and the Doppler observation. Satellite positioning devices are widely applied in fields such as map navigation, surveying, location services, and deep space detection, such as map navigation for smartphones and high-precision land surveying. The observation data output from the satellite positioning equipment includes pseudorange, pseudorange rate and accumulated delta range (ADR). The pseudorange measures the geometric distance from the satellite to the satellite positioning equipment, the pseudorange rate observation measures the Doppler effect due to the relative motion between the satellite and the satellite, and the ADR measures the amount of change in geometric distance from the satellite to the satellite positioning equipment.
[0017] In the satellite positioning process, the pseudorange means an approximate distance between a ground receiver (e.g., a satellite positioning device attached to a mobile device) and a satellite. Assuming that the satellite clock and the receiver clock are strictly synchronized, the signal propagation time can be obtained based on the transmission time of the satellite signal and the reception time of the signal received by the receiver, and the distance from the satellite to the earth can be obtained by multiplying the propagation speed. However, since there is an inevitable clock bias in the two clocks and the signal is affected by factors such as refraction by the atmosphere during the propagation process, the distance directly measured in this manner is not equal to the true distance from the satellite to the ground receiver, and such a distance is called a pseudorange. The pseudorange observation data in the embodiment of the present application means the distance observation data between the satellite and the mobile device.
[0018] About the CORS (Continuously Operating Reference Stations) system: The CORS system is a product of deep multi-faceted development of advanced technologies such as satellite positioning technology, computer network technology, and digital communication technology. The CORS system consists of five parts: a reference station network, a data processing center, a data transmission system, a positioning and navigation data distribution system, and a user system. Each reference station and the detection and analysis center are connected together through the data transmission system to form a dedicated network.
[0019] RTK (Real-Time Kinematic) differential positioning technology is called real-time kinematic differential positioning technology and also called carrier phase differential positioning technology. RTK differential positioning technology is a real-time kinematic positioning technology based on carrier phase observation values, which provides three-dimensional positioning results in a specified coordinate system of an observation point in real time and can achieve an accuracy of the order of centimeters. In the RTK positioning mode, the reference station transmits its observation value together with observation station coordinate information to the mobile station via a data link, and the mobile station not only receives data from the reference station via a data link, but also collects and processes satellite observation data in real time. Compared with traditional point positioning, RTK differential positioning can not only eliminate the effects of errors caused by atmospheric delay, satellite clock bias and terminal receiver clock bias, but also eliminate the effects of spatial system errors, propagation errors and environmental errors, and the positioning accuracy and stability are both superior to traditional point positioning. For example, a comparison diagram of the effects of point positioning and RTK differential positioning is shown in Figure 1. The positioning error of conventional point positioning is 5 to 20 m (meters), and the positioning error of RTK differential positioning is 3 to 5 cm (centimeters).
[0020] About Laser Radar: A distance sensor that uses infrared light as a laser light source is also called laser radar. It uses a reflection principle similar to that of radar, and obstacles within the effective range of the laser will block the light source and cause reflections, so that 3D (three-dimensional) obstacle distance information on the same plane as the laser light source can be obtained, and matching positioning or attitude resolution is performed based on the obtained information. Currently, laser radar is being installed in an increasing number of mobile devices.
[0021] Quartiles, also called quartiles, are a set of data that are divided into four equal parts, each part containing 25% of the data, and the numbers at each quartile are quartiles. There are three quartiles, the first quartile is commonly referred to as the lower quartile, the second quartile is the median, and the third quartile is the upper quartile, represented by Q1, Q2, and Q3, respectively. The first quartile (Q1) is also called the lower quartile and is equal to the 25th percentile number after all the numbers in the sequence are sorted from smallest to largest, the second quartile (Q2) is also called the median and is equal to the 50th percentile number after all the numbers in the sequence are sorted from smallest to largest, and the third quartile (Q3) is also called the higher quartile and is equal to the 75th percentile number after all the numbers in the sequence are sorted from smallest to largest.
[0022] Pseudorange observation data is an approximate distance between a satellite signal receiver (eg, satellite positioning equipment) and a satellite in a satellite positioning process.
[0023] Doppler observations are Doppler measurements or counts of radio signals transmitted from a satellite as measured by a satellite signal receiver.
[0024] The carrier phase observation data is the phase difference between the carrier signal or subcarrier signal emitted from the satellite and the local oscillator signal of the satellite signal receiver.
[0025] The altitude angle is the angle between the horizontal plane and the line of direction from the point where the satellite signal receiver is located to the satellite.
[0026] Clock bias is a clock error, and in this application clock bias refers to satellite clock bias and mobile device clock bias, where satellite clock bias means the difference between the satellite clock and standard time, and mobile device clock bias is also called receiver clock bias, i.e., the difference between the receiver clock and standard time.
[0027] Clock drift is the rate of change of the clock bias, and in this application clock drift refers to mobile device clock drift and satellite clock drift, where mobile device clock drift means the rate of change of the receiver clock bias and satellite clock drift means the rate of change of the satellite clock bias.
[0028] An Epoch represents the start time of an event or a period, or the reference date of a measurement system. In order to compare observations at different times, it is necessary to specify the observation time corresponding to the observational material, and such a time is called the observation epoch.
[0029] In the related art, a satellite positioning device attached to a mobile device calculates a positioning result of the mobile device in real time based on received observation data, but the positioning accuracy of such a positioning method is limited by the quality of the observation data, and when the quality of the observation data is poor, problems such as inaccurate positioning and low robustness of positioning are very likely to occur, making it difficult to meet actual positioning needs. Therefore, there is a need to provide a positioning method that can improve the positioning accuracy and robustness.
[0030] FIG. 2 is a schematic diagram of an implementation environment of the positioning method according to the embodiment of the present application. As shown in FIG. 2, the implementation environment may include: a mobile device 110, a reference station 120, a satellite cluster 130 and a server 140.
[0031] The mobile device 110 is connected to the server 140 via a wireless network or a wired network. Preferably, the mobile device 110 may be, but is not limited to, a mobile phone, a computer, a smart voice dialogue device, a smart home appliance, an in-vehicle terminal, a helicopter, etc. An application program supporting a positioning service is installed and executed on the mobile device 110. In some embodiments, a navigation application program is executed on the mobile device 110, and a user can realize a navigation function through the navigation application program. In some embodiments, a satellite positioning device is installed on the mobile device 110, and the mobile device 110 can communicate with the satellite cluster 130 through the satellite positioning device to obtain observation data. In some embodiments, the mobile device 110 is installed with a radar that can scan point cloud data around the mobile device 110.
[0032] Preferably, the reference station 120 is a CORS system. The reference station 120 can communicate with the satellite cluster 130 to obtain parameters of each satellite in the satellite cluster 130, and of course, the reference station 120 can also communicate with the mobile device 110 or the server 140 to transmit the navigation ephemeris and original observation data of the satellite cluster to the mobile device 110 or the server 140, etc.
[0033] Preferably, server 140 is an independent physical server, or a server cluster or distributed system composed of multiple physical servers, or a cloud server providing basic cloud computing services such as cloud services, cloud databases, cloud computing, cloud functions, cloud storage, network services, cloud communications, middleware services, domain name services, security services, Content Delivery Network (CDN), and big data and artificial intelligence platforms. In some embodiments, server 140 can communicate with mobile device 110, and server 140 provides navigation-related computing services (e.g., differentiated service delivery, position reporting, etc.). In some embodiments, server 140 is also referred to as a high precision positioning server platform.
[0034] The positioning method according to the embodiments of the present application is performed by a computer device, which may be a mobile device 110 or a server 140; that is, the positioning method according to the embodiments of the present application may be performed by the mobile device 110, may be performed by the server 140, or may even be jointly performed by the mobile device 110 and the server 140, and the embodiments of the present application are not limited thereto.
[0035] Those skilled in the art should understand that the above mobile device 110, reference station 120, satellite cluster 130 and server 140 are merely examples, and other existing or future mobile devices, reference stations, satellite clusters or servers, if applicable to this application, should be included in the scope of protection of this application and are incorporated herein by reference.
[0036] For example, the positioning method according to the embodiment of the present application may be applied to a vehicle-mounted scene, a map field, and even a traffic field, etc.
[0037] Based on the implementation environment shown in Fig. 2, an embodiment of the present application provides a positioning method, and takes as an example that the method is applied to a mobile device 110. As shown in Fig. 3, the positioning method according to the embodiment of the present application may include the following steps 301 to 303.
[0038] In step 301, point cloud data scanned by a radar attached to a mobile device is acquired, and the mobile device is positioned using the point cloud data to acquire a first positioning result.
[0039] A radar is installed on the mobile device, and the radar can scan the surrounding point cloud data in real time, and the mobile device can acquire the point cloud data scanned by the radar. It should be noted that the acquired point cloud data in the embodiment of the present application refers to the point cloud data scanned by the radar at the current positioning time.
[0040] Exemplarily, the radar attached to the mobile device may refer to a laser radar, which detects obstacles within an effective range by emitting a laser light, and can scan information of obstacles on the same plane as the laser light source by emitting a laser light, and the information of the obstacles can be represented by point cloud data. Exemplarily, the point cloud data may refer to three-dimensional point cloud data or two-dimensional point cloud data. The point cloud data is a data set of points in a certain coordinate system, and the data of each point may include position information, color information, reflection intensity information, etc.
[0041] The acquisition of point cloud data is related to radar and not related to GNSS signals, and regardless of the quality of the GNSS signals, any radar installed on a mobile device can scan the point cloud data, and further, by obtaining a first positioning result of the mobile device based on the point cloud data, the first positioning result can be used to provide data support for obtaining a final target positioning result, and the accuracy and robustness of the target positioning result can be improved by reducing the dependency of the target positioning result on the quality of the GNSS signals.
[0042] In an exemplary embodiment, a process of positioning a mobile device using point cloud data and obtaining a first positioning result includes the steps of matching the point cloud data with historical point cloud data located in a previous frame of the point cloud data to obtain point cloud matching information, determining a position change amount based on the point cloud matching information, correcting the historical position of the mobile device based on the position change amount to obtain a first position, and setting the positioning result including the first position as the first positioning result.
[0043] For example, the historical point cloud data located in one frame before the point cloud data may refer to the point cloud data scanned at the previous scan time by a radar attached to a mobile device. The process of matching the point cloud data with the historical point cloud data located in one frame before the point cloud data may be realized based on an NDT (Normal Distributions Transform) algorithm. NDT can determine the optimal matching between two point clouds through a standard optimization technique, and since feature calculation and matching of corresponding points are not used in the registration process, the matching speed is faster than other methods. The NDT registration algorithm is stable in time, has little dependence on the initial value, and can effectively correct even when the error of the initial value is large.
[0044] The point cloud matching information indicates a point cloud matching relationship between the point cloud data and historical point cloud data located one frame before the point cloud data. A position change amount indicating a change situation of a current position with respect to a historical position can be determined based on the point cloud matching information. The historical position means a position in a historical positioning result, and the historical positioning result may mean a positioning result at a positioning time before the current positioning time.
[0045] After determining the amount of position change, the mobile device's historical position is corrected based on the amount of position change to obtain a first position. The first position can be regarded as the current position of the mobile device determined based on the point cloud data. Exemplarily, the manner of correcting the mobile device's historical position based on the amount of position change to obtain the first position may be a sum of the amount of position change and the historical position as the first position.
[0046] Exemplarily, the accuracy of the position change amount determined based on the point cloud matching information may be low, and after obtaining the position change amount, a correction equation corresponding to the position change amount may be determined, and the correction equation corresponding to the position change amount indicates how to correct the historical position of the mobile device based on the position change amount. Exemplarily, the position change amount is substituted into a correction equation with an unknown position change amount to obtain a correction equation corresponding to the position change amount. The correction equation with an unknown position change amount may be empirically set. In some embodiments, the correction equation corresponding to the position change amount may be referred to as a constraint equation corresponding to the position change amount.
[0047] After determining the correction equation corresponding to the amount of position change, the historical position of the mobile device is corrected based on the correction equation corresponding to the amount of position change, and the corrected position is set as the first position. Exemplarily, the correction equation corresponding to the amount of position change may be an equation in which the position to be corrected is an independent variable and the corrected position is a dependent variable, and a manner of correcting the historical position of the mobile device based on the correction equation corresponding to the amount of position change and acquiring the first position may be to substitute the historical position as a value of the independent variable into the correction equation corresponding to the amount of position change, and to acquire the first position as a value of the dependent variable.
[0048] Exemplarily, the manner of correcting the historical position of the mobile device based on the position change amount and acquiring the first position may be to use the sum of the position change amount and the historical position of the mobile device as a reference position, and to filter and correct the reference position using a reference filter to acquire the first position. The reference filter may be any filter, and exemplarily, the type of the reference filter may include, but is not limited to, a Kalman filter (EF), an extended Kalman filter (EKF), an unscented Kalman filter, a robust Kalman filter, etc. In the process of filtering and correcting the reference position using the reference filter, the state parameters to be corrected by the reference filter are determined based on the reference position, and the matrices (e.g., a measurement update matrix, a measurement variance matrix, etc.) required for the filtering and correction may be set based on the matching degree of the point cloud matching information.
[0049] After determining the first position, the positioning result including the first position is the first positioning result of the mobile device. The embodiment of the present application does not limit the type of parameters included in the first positioning result, as long as it ensures that the type of parameters included in the first positioning result includes a position type. Exemplarily, the type of parameters included in the first positioning result may include a speed type in addition to the position type. Exemplarily, for a situation in which the type of parameters included in the first positioning result further includes a speed type, the speed in the historical positioning result may be the speed in the first positioning result, or the speed set based on experience may be the speed in the first positioning result, and the embodiment of the present application does not limit this.
[0050] Exemplarily, a process of using point cloud data to position a mobile device and obtain a first positioning result may be as shown in Fig. 4. First, obtain point cloud data scanned by a radar attached to the mobile device, then match the point cloud data with historical point cloud data located in one frame before the point cloud data based on an NDT algorithm to obtain a position change amount, determine a constraint equation corresponding to the position change amount, correct the historical position according to the constraint equation corresponding to the position change amount to obtain a first position, and the positioning result including the first position is the first positioning result.
[0051] In step 302, first observation data received by a satellite positioning device attached to the mobile device is acquired.
[0052] A satellite positioning device is installed in the mobile device, and the satellite positioning device can receive observation data provided by the GNSS system in real time, and the mobile device can acquire the observation data received by the satellite positioning device. It should be noted that in the embodiment of the present application, the acquired first observation data refers to the observation data received by the satellite positioning device at the current positioning time. Exemplarily, the first observation data may include at least one of first pseudorange observation data, first Doppler observation data, and first carrier phase observation data.
[0053] Exemplarily, the first observation data refers to observation data for a first satellite, i.e., observation data between the first satellite and the mobile device, and the first satellite refers to each satellite that acquires a signal at the current positioning time of the mobile device. Exemplarily, in order to ensure the accuracy of the positioning result acquired based on the observation data, the number of first satellites is multiple. The first observation data includes observation sub-data corresponding to the first satellites, and each observation sub-data corresponds to each first satellite. If the first observation data includes first pseudorange observation data, the observation sub-data corresponding to any of the first satellites includes pseudorange observation sub-data corresponding to any of the first satellites; if the first observation data includes first Doppler observation data, the observation sub-data corresponding to any of the first satellites includes Doppler observation sub-data corresponding to any of the first satellites; if the first observation data includes first carrier phase observation data, the observation sub-data corresponding to any of the first satellites includes carrier phase observation sub-data corresponding to any of the first satellites.
[0054] Exemplarily, the mobile device may be connected to the CORS system via an NTRIP protocol, and send an observation data acquisition request to the CORS system, and then the CORS system may distribute the first observation data to the satellite positioning device attached to the mobile device, so that the satellite positioning device attached to the mobile device receives the first observation data. The NTRIP protocol refers to a protocol for networked transport of RTCM via Internet Protocol, and RTCM refers to a protocol established by the Radio Technical Commission for Maritime Services. In some embodiments, the observation data acquisition request sent by the mobile device to the CORS system may also be referred to as an observation data distribution request.
[0055] Exemplarily, the mobile device may not only send an observation data distribution request to the CORS system, but also send an ephemeris acquisition request to the CORS system, and in order to allow the mobile device to acquire the navigation ephemeris of the first satellite, the CORS system may acquire the navigation ephemeris of the first satellite from the satellite ephemeris database after receiving the ephemeris acquisition request, and transmit the navigation ephemeris of the first satellite to the mobile device. The navigation ephemeris of the first satellite may include a set of parameter lists for determining the status information of the first satellite. Exemplarily, the CORS system may transmit the navigation ephemeris of the first satellite to the mobile device in the form of a binary stream.
[0056] For example, the mobile device may obtain status information of the first satellite based on the first observation data and the navigation ephemeris of the first satellite, where if the first observation data includes only the first pseudorange observation data, the status information of the first satellite includes a satellite position and a satellite clock bias, where if the first observation data includes only the first Doppler observation data, the status information of the first satellite includes a satellite velocity (i.e., a satellite traveling speed) and a satellite clock drift, and where if the first observation data includes the first pseudorange observation data and the first Doppler observation data, the satellite status information in this case includes a satellite position, a satellite clock bias, a satellite velocity, and a satellite clock drift.
[0057] Exemplarily, the number of first satellites may be N (N is a positive integer), and one first satellite corresponds to one pseudorange observation data, one Doppler observation data, one satellite position, one satellite clock bias, one satellite velocity, and one satellite clock drift at the same time, and the satellite positions, satellite clock biases, satellite velocities, and satellite clock drifts corresponding to different first satellites may be different. For example, when the first observation data includes the first pseudorange observation data, the satellite positions and satellite clock biases corresponding to each first satellite can be calculated based on the received first pseudorange observation data and the navigation ephemeris of the first satellite, and when the first observation data includes the first Doppler observation data, the satellite velocities and satellite clock drifts corresponding to each first satellite can be calculated based on the received first Doppler observation data and the navigation ephemeris of the first satellite.
[0058] For illustrative purposes, a location in the embodiments of the present application may refer to a location in an Earth Centered Earth Fixed (ECEF) Cartesian coordinate system, in which the ECEF coordinate system has the Earth's center O as its coordinate origin, the Z-axis points to the North Pole of the conventional Earth, the X-axis points to an intersection of the prime meridian and the Earth's equator, and the X, Y, and Z axes together form a right-handed Cartesian coordinate system.
[0059] Exemplarily, when acquiring the first observation data, the signal-to-noise ratio of the first observation data and the altitude angle of the first satellite may be acquired. The signal-to-noise ratio is also called the carrier-to-noise ratio and is a standard measurement scale expressing the relationship between the carrier and the carrier noise. The observation sub-data corresponding to each first satellite included in the first observation data correspond to each signal-to-noise ratio, and the signal-to-noise ratios of different types of observation sub-data corresponding to any first satellite may be the same or different. Exemplarily, the altitude angle of the first satellite means the angle between the direction line of the line connecting the satellite positioning device attached to the mobile device and the first satellite and the horizontal plane of the mobile device. Exemplarily, the signal-to-noise ratio of the first observation data and the altitude angle of the first satellite may be determined based on the first observation data by the CORS system and transmitted to the mobile device, or may be determined by the mobile device itself based on the first observation data, and the embodiment of the present application is not limited thereto.
[0060] In step 303, a target positioning result for the mobile device is obtained based on the first observation data and the first positioning result.
[0061] The first observation data is observation data received by a satellite positioning equipment attached to the mobile device, and the first positioning result is a positioning result obtained using point cloud data scanned by a radar attached to the mobile device. Obtaining a target positioning result of the mobile device based on the first observation data and the first positioning result is advantageous in reducing the dependence of the positioning process on either one of the point cloud data or the first observation data. Even if the quality of the point cloud data or the first observation data is low, the accuracy of the target positioning result can be guaranteed by taking the other data into consideration, the probability of positioning failure can be reduced, and the robustness of positioning can be improved.
[0062] In one possible implementation manner, the implementation process of obtaining a target positioning result of the mobile device based on the first observation data and the first positioning result includes the following steps 3031 and 3032.
[0063] In step 3031, target data is obtained based on the first observation data, the target data including at least one of the first observation data and double-difference observation data obtained by calculation based on the first observation data and reference observation data received by a satellite positioning device attached to a reference station.
[0064] The target data is data necessary for obtaining a target positioning result based on the first positioning result, and the target data is data related to satellite observation, and the data related to satellite observation can improve the accuracy of positioning by mutually complementing the point cloud data on which the first positioning result is obtained. Exemplarily, the target data may include only the first observation data, may include only the double difference observation data, or may further include the first observation data and the double difference observation data. The specific situation of the target data may be set based on experience, or may be flexibly adjusted according to the actual application scene, and the embodiment of the present application is not limited thereto. Exemplarily, for a situation in which the target data includes the first observation data and the double difference observation data, the data related to satellite observation on which the target positioning result is obtained is more comprehensive, which is advantageous to further improve the accuracy of the target positioning result.
[0065] When the target data is different, the realization method of obtaining the target data based on the first observation data is different. Exemplarily, when the target data includes only the first observation data, the realization method of obtaining the target data based on the first observation data is to use the first observation data as the target data. Exemplarily, when the target data includes only the double difference observation data, the realization method of obtaining the target data based on the first observation data is to obtain the reference observation data, calculate the double difference observation data based on the first observation data and the reference observation data, and use the double difference observation data as the target data. Exemplarily, when the target data includes the first observation data and the double difference observation data, the realization method of obtaining the target data based on the first observation data is to obtain the reference observation data, calculate the double difference observation data based on the first observation data and the reference observation data, and use the data including the first observation data and the double difference observation data as the target data.
[0066] The reference observation data is observation data received by a satellite positioning device attached to a reference station. The reference station may be any base station to which a satellite positioning device is attached, and the observation data for a first satellite received by the satellite positioning device attached to the reference station is the reference observation data. The reference observation data includes reference observation sub-data corresponding to the first satellite. Exemplarily, the reference observation sub-data corresponding to the first satellite includes at least one of reference pseudorange observation sub-data, reference Doppler observation sub-data, and reference carrier phase observation sub-data corresponding to the first satellite.
[0067] Exemplarily, the reference station is a base station whose location is fixed and known, and thus provides data support for the positioning of the mobile device. Exemplarily, the reference observation data received by the satellite positioning device installed in the reference station may be obtained by communicating with a CORS system or by communicating with the reference station, and the embodiment of the present application is not limited thereto.
[0068] After obtaining the reference observation data, the double difference observation data may be calculated based on the first observation data and the reference observation data. Exemplarily, the first observation data includes first pseudorange observation sub-data and first carrier phase observation sub-data corresponding to a first satellite, and the reference observation data includes reference pseudorange observation sub-data and reference carrier phase observation sub-data corresponding to the first satellite. The double difference observation data includes pseudorange double difference observation data and carrier phase double difference observation data. In some embodiments, the double difference observation data may be in other situations, which are not listed one by one here.
[0069] Exemplarily, the pseudorange double difference observation data includes pseudorange double difference observation values corresponding to each of the other satellites other than the reference satellite among the first satellites, the pseudorange double difference observation value corresponding to any of the other satellites is a difference value between a first pseudorange observation differential value corresponding to any of the other satellites and a second pseudorange observation differential value corresponding to any of the other satellites, the first pseudorange observation differential value corresponding to any of the other satellites is a difference value between a first pseudorange observation sub-data corresponding to the reference satellite and a first pseudorange observation sub-data corresponding to any of the other satellites, and the second pseudorange observation differential value corresponding to any of the other satellites is a difference value between a reference pseudorange observation sub-data corresponding to the reference satellite and a reference pseudorange observation sub-data corresponding to any of the other satellites. The reference satellite is any of the first satellites, and may be selected based on experience.
[0070] For example, taking the first satellite 1 as the reference satellite, the pseudorange double difference observation value corresponding to the first satellite 2 is: TIFF2024543946000002.tif5170, where: TIFF2024543946000003.tif5170 represents the first pseudorange observation subdata corresponding to the first satellite 1; TIFF2024543946000004.tif5170 represents the first pseudorange observation subdata corresponding to the first satellite 2; TIFF2024543946000005.tif5170 represents the reference pseudorange observation sub-data corresponding to the first satellite 1; TIFF2024543946000006.tif5170 represents the reference pseudorange observation sub-data corresponding to the first satellite 2.
[0071] Illustratively, the carrier phase double difference observation data includes carrier phase double difference observation values corresponding to each of the first satellites other than the reference satellite, and the carrier phase double difference observation value corresponding to any of the other satellites is a differential value between a first carrier phase observation differential value corresponding to any of the other satellites and a second carrier phase observation differential value corresponding to any of the other satellites, the first carrier phase observation differential value corresponding to any of the other satellites is a differential value between a first carrier phase observation sub-data corresponding to the reference satellite and a first carrier phase observation sub-data corresponding to any of the other satellites, and the second carrier phase observation differential value corresponding to any of the other satellites is a differential value between a reference carrier phase observation sub-data corresponding to the reference satellite and a reference carrier phase observation sub-data corresponding to any of the other satellites.
[0072] For example, if the first satellite 1 is the reference satellite, the carrier phase double difference observation value corresponding to the first satellite 2 is: TIFF2024543946000007.tif5170, where: TIFF2024543946000008.tif5170 represents the first carrier phase observation sub-data corresponding to the first satellite 1; TIFF2024543946000009.tif5170 represents the first carrier phase observation sub-data corresponding to the first satellite 2; TIFF2024543946000010.tif5170 represents the reference carrier phase observation sub-data corresponding to the first satellite 1; TIFF2024543946000011.tif5170 represents the reference carrier phase observation sub-data corresponding to the first satellite 2.
[0073] Exemplarily, the double difference observation data is obtained based on the first observation data received by the satellite positioning equipment attached to the mobile device and the reference observation data received by the satellite positioning equipment attached to the reference station, and the double difference observation data can not only take into account the difference between the observation sub-data of the same satellite received by the satellite positioning equipment attached to the mobile device and the satellite positioning equipment attached to the reference station, but also take into account the difference between the observation sub-data of different satellites received by the same satellite positioning equipment (the satellite positioning equipment attached to the mobile device or the satellite positioning equipment attached to the reference station). Taking into account the double difference observation data can eliminate certain errors (e.g., errors due to atmospheric delay, errors due to satellite clock bias and mobile device clock bias, etc.), which is advantageous to improving the accuracy of positioning.
[0074] In step 3032, a target positioning result is obtained based on the first positioning result, based on the target data.
[0075] The target data may include only the first observation data, may include only the double difference observation data, or may include the first observation data and the double difference observation data. When the target data is different, the specific implementation process of obtaining the target positioning result based on the first positioning result based on the target data is different. The specific implementation process of obtaining the target positioning result based on the first positioning result based on the target data will be described in detail below and will not be described again here.
[0076] Exemplarily, the process of obtaining the target positioning result based on the first positioning result based on the target data is realized according to a result obtaining method corresponding to the target data, and the result obtaining method corresponding to the target data is used to instruct how to obtain the target positioning result based on the first positioning result based on the target data. The result obtaining method corresponding to the target data may be set based on experience, or may be flexibly adjusted based on the application scene, and the embodiment of the present application does not limit this. Exemplarily, the result obtaining method corresponding to the target data in different cases is different, and the result obtaining method corresponding to the target data in any case may be any method among a plurality of candidate methods, and each candidate method corresponds to one specific realization process.
[0077] It should be noted that the above steps 3031 and 3032 are exemplary implementation manners for obtaining a target positioning result of a mobile device based on the first observation data and the first positioning result, and the embodiments of the present application are not limited thereto. In some embodiments, the first observation data is directly defaulted as data required for obtaining a target positioning result based on the first positioning result, so that the target positioning result can be directly obtained based on the first observation data and the first positioning result.
[0078] In the positioning method according to an embodiment of the present application, the final target positioning result of the mobile device is obtained by comprehensively taking into consideration the point cloud data scanned by the radar attached to the mobile device and the first observation data received by the satellite positioning device, and the point cloud data and the first observation data can complement each other. Such a positioning method can reduce the dependency on any one of the point cloud data and the first observation data. Even if the quality of the point cloud data or the first observation data is poor, a more accurate target positioning result can be obtained by additionally taking into consideration the other data, which is highly robust and advantageous in meeting actual positioning needs.
[0079] In addition, the target data required to obtain the target positioning result based on the first positioning result is data related to satellite observation, and the data related to satellite observation and the point cloud data on which the first positioning result is obtained are mutually complemented to improve the accuracy of the positioning. When the target data includes the first observation data and the double difference observation data, the data related to satellite observation on which the target positioning result is obtained is more comprehensive, which is advantageous to further improve the accuracy of the target positioning result.
[0080] The double difference observation data can not only take into account the difference between the observation sub-data of the same satellite received by the satellite positioning equipment installed in the mobile device and the satellite positioning equipment installed in the reference station, but also take into account the difference between the observation sub-data of different satellites received by the same satellite positioning equipment (the satellite positioning equipment installed in the mobile device or the satellite positioning equipment installed in the reference station). Taking into account the double difference observation data can eliminate certain errors (e.g., errors due to atmospheric delay, errors due to satellite clock bias and mobile device clock bias, etc.), which is advantageous to improving the accuracy of positioning.
[0081] The embodiment of the present application provides an implementation process for obtaining a target positioning result based on a first positioning result according to target data, and the implementation process is a specific implementation process when the target data includes first observation data and double difference observation data. Take the method as an example for application to a mobile device 110. As shown in FIG. 5, the method according to the embodiment of the present application may include the following steps 501 and 502.
[0082] In step 501, the first positioning result is corrected using the first observation data to obtain a first corrected result.
[0083] The first correction result is a result obtained by correcting the first positioning result using the first observation data, and illustratively, the type of parameters included in the first correction result is the same as the type of parameters included in the first positioning result. Exemplarily, the process of correcting the first positioning result using the first observation data can be realized using a first filter. The first filter may be any filter, and illustratively, the type of the first filter may include, but is not limited to, a Kalman filter, an extended Kalman filter, an unscented Kalman filter, a robust Kalman filter, etc., and the embodiment of the present application is not limited thereto.
[0084] In one possible implementation manner, as shown in FIG. 5, an implementation process of correcting the first positioning result using the first observation data to obtain the first corrected result includes the following steps 5011 to 5014.
[0085] In step 5011, first state parameters of a first filter are obtained based on a first positioning result, and a first state covariance matrix corresponding to the first state parameters is obtained.
[0086] The first state parameter is a state parameter to be updated that the first filter has. For example, the type of the parameter in the state parameter of the first filter includes the type of the parameter in the positioning result of the mobile device. For example, the type of the parameter in the positioning result of the mobile device includes position and speed. The state parameter is: TIFF2024543946000012.tif5170, where [] T represents the transpose of a matrix, TIFF2024543946000013.tif4170 and TIFF2024543946000014.tif4170 represents the position and velocity of a mobile device, TIFF2024543946000015.tif4170 represents the clock bias of the mobile device (i.e., the receiver clock bias), TIFF2024543946000016.tif4170 represents the clock drift of a mobile device (i.e., the receiver clock drift). TIFF2024543946000017.tif4170 and TIFF2024543946000018.tif4170 is the position and velocity in the ECEF coordinate system.
[0087] In an exemplary embodiment, the manner of obtaining the first state parameter of the first filter based on the first positioning result may be: taking the first positioning result as the first state parameter. In an exemplary embodiment, the manner of obtaining the first state parameter of the first filter based on the first positioning result may further be: taking the first positioning result as an initial state parameter, and performing time update on the initial state parameter to obtain the first state parameter.
[0088] The first state covariance matrix may characterize the correlation between the first state parameters, and the first state covariance matrix may be a diagonal matrix and also a symmetric matrix. Exemplarily, for a situation in which the first positioning result is the first state parameter, the first state covariance matrix may be set empirically, for example, by setting the first state covariance matrix as Set it to TIFF2024543946000019.tif5170, where: TIFF2024543946000020.tif5170 represents a diagonal matrix. For example, in a situation where the first positioning result is used as an initial state parameter and the initial state parameter is time-updated to obtain the first state parameter, a manner of obtaining the first state covariance matrix corresponding to the first state parameter may be to obtain an initial state covariance matrix corresponding to the initial state parameter, perform time-updating on the initial state covariance matrix, and use the covariance matrix obtained by time-updating as the first state covariance matrix corresponding to the first state parameter.
[0089] It is taken as an example that the first state parameters are obtained by performing a time update on the initial state parameters, and the first state covariance matrix is obtained by performing a time update on the initial state covariance matrix.
[0090] In the process of time updating the initial state parameters, the initial state parameters are updated one or more times, and the initial state parameters of the first filter are It can also be written as TIFF2024543946000021.tif5170, TIFF2024543946000022.tif5170 is considered to be the state parameters at time 0 of the first filter, and the initial state covariance matrix of the first filter is It can also be written as TIFF2024543946000023.tif5170, TIFF2024543946000024.tif5170 is considered to be the state covariance matrix of the first filter at time 0, and the next (at time 1) state parameters for the first filter are We can write it as TIFF2024543946000025.tif5170, and the state covariance matrix By analogy, the state parameters of the first filter at time t can be written as We may write it as TIFF2024543946000027.tif5170, and the state covariance matrix at time t may be written as TIFF2024543946000028.tif5170. Assuming the current time is time t, TIFF2024543946000029.tif5170 is the first state parameter of the first filter, TIFF2024543946000030.tif5170 is the first state covariance matrix of the first filter.
[0091] Illustratively, the process of performing a time update on the initial state covariance matrix is: At time TIFF2024543946000031.tif4170, the state covariance matrix of the filter is Assuming it is TIFF2024543946000032.tif5170, This includes calculating and obtaining the state covariance matrix of the filter at time TIFF2024543946000033.tif4170 based on the following equation 1. TIFF2024543946000034.tif6170, where TIFF2024543946000035.tif5170 is the first filter TIFF2024543946000036.tif4170 represents the state covariance matrix at time, TIFF2024543946000037.tif5170 represents the state transition matrix. TIFF2024543946000038.tif5170 may be obtained by calculation based on the following formula 2: TIFF2024543946000039.tif5170 represents the noise covariance matrix, TIFF2024543946000040.tif5170 may be obtained by calculation based on the following formula 3: TIFF2024543946000041.tif5170 represents the transpose of the state transition matrix. TIFF2024543946000042.tif24170, where TIFF2024543946000043.tif4170 represents the time difference between adjacent epochs, TIFF2024543946000044.tif4170 represents the identity matrix, TIFF2024543946000045.tif4170 represents the associated time of a Markov process, usually an empirical value. TIFF2024543946000046.tif40170, where TIFF2024543946000047.tif4170 represents the time difference between adjacent epochs, TIFF2024543946000048.tif5170 represents the velocity system noise of the first filter, TIFF2024543946000049.tif5170 may be calculated based on the variance values corresponding to the historical velocity sequence and the time differences of adjacent epochs; TIFF2024543946000050.tif4170 shows the clock bias noise of the first filter. TIFF2024543946000051.tif4170 may be calculated based on the variance values corresponding to the historical clock bias sequence and the time differences of adjacent epochs; TIFF2024543946000052.tif4170 shows the clock drift noise of the first filter. TIFF2024543946000053.tif4170 may be calculated and obtained based on the variance value corresponding to the historical clock drift sequence and the time difference of adjacent epochs. Exemplarily, the historical velocity sequence, the historical clock bias sequence and the historical clock drift sequence may be determined from the historical positioning results corresponding to the mobile device by a time sliding window. Exemplarily, the historical positioning result information corresponding to the mobile device may refer to the positioning results obtained in the process of decomposing the state parameters of the mobile device based on the first observation data.
[0092] Illustratively, the process of performing time updates on the initial state parameters is: At time TIFF2024543946000054.tif4170, the state parameters of the first filter are calculated and obtained based on Equation 4. TIFF2024543946000055.tif5170, where TIFF2024543946000056.tif5170 is the first filter TIFF2024543946000057.tif4170 represents the state parameters at time, TIFF2024543946000058.tif5170 is the first filter TIFF2024543946000059.tif4170 represents the state parameters at time, TIFF2024543946000060.tif5170 represents a state transition matrix.
[0093] According to Equation 4, the time update process for the initial state parameters of the first filter can be realized, and according to the above Equations 1 to 3, the time update process for the initial state covariance matrix of the first filter can be realized. After completing the time update, the state parameters of the first filter are called the first state parameters, and the state covariance matrix of the first filter is called the first state covariance matrix.
[0094] In step 5012, in response to the first observation data satisfying the first screening condition, a first observation residual matrix is obtained based on the first observation data and the first state parameters, and a first measurement update matrix and a first measurement variance matrix corresponding to the first observation residual matrix are determined.
[0095] The first observation data satisfying the first screening condition indicates that the first observation data is reliable and can be directly used to update the first state parameters. In the process of updating the first state parameters using the first observation data, it is first necessary to obtain a first observation residual matrix based on the first observation data and the first state parameters, and then determine a first measurement update matrix and a first measurement variance matrix corresponding to the first observation residual matrix. The first measurement variance matrix, the first measurement update matrix, and the first observation residual matrix are matrices required to update the first state parameters of the first filter, which are determined based on the first observation data and the first state parameters.
[0096] Exemplarily, the first observation residual matrix is constructed based on the first observation data, the first state parameters, and state information of the satellite (i.e., the first satellite) that is the target of the first observation data, the first measurement update matrix is a Jacobian matrix related to the first state parameters of the first observation residual matrix, and the first measurement variance matrix is constructed based on the signal-to-noise ratio of the first observation data and the altitude angle of the satellite that is the target of the first observation data. The principle of obtaining the first observation residual matrix, the first measurement update matrix, and the first measurement variance matrix is the same as the principle of obtaining the initial observation residual matrix, the initial Jacobian matrix, and the initial measurement variance matrix in the embodiment shown in Fig. 8, and will not be described repeatedly here. Exemplarily, the first measurement variance matrix may further be constructed based on the signal-to-noise ratio of the first observation data, the altitude angle of the satellite that is the target of the first observation data, and the observation random error model factor (e.g., pseudorange observation random error model factor, Doppler observation random error model factor) obtained by decomposition in the embodiment shown in Fig. 8.
[0097] For example, in a situation where the first observation data includes the first pseudorange observation data and the first Doppler observation data, the first observation residual matrix includes the first pseudorange observation residual matrix and the first Doppler observation residual matrix, the first measurement update matrix includes the first pseudorange measurement update matrix and the first Doppler measurement update matrix, and the first measurement variance matrix includes the first pseudorange measurement variance matrix and the first Doppler measurement variance matrix. Of course, the first observation data may be in other situations, and the situations of the first observation residual matrix, the first measurement update matrix, and the first measurement variance matrix change with the change of the situation of the first observation data. For example, if the first observation data includes only the first pseudorange observation data, the first observation residual matrix includes only the first pseudorange observation residual matrix, the first measurement update matrix includes only the first pseudorange measurement update matrix, and the first measurement variance matrix includes only the first pseudorange measurement variance matrix. If the first observation data includes only the first Doppler observation data, the first observation residual matrix includes only the first Doppler observation residual matrix, the first measurement update matrix includes only the first Doppler measurement update matrix, and the first measurement variance matrix includes only the first Doppler measurement variance matrix.
[0098] In an exemplary embodiment, the process of determining whether the first observation data satisfies the first screening condition includes the following steps a and b.
[0099] In step a, model validation parameter values corresponding to a first filter are determined based on the first observation data, the first state parameters, and the first state covariance matrix.
[0100] The model validation parameter value can be used to determine whether the first filter system is faulty. In one possible implementation manner, the implementation process of determining the model validation parameter value corresponding to the first filter based on the first observation data, the first state parameters, and the first state covariance matrix includes: obtaining a first observation residual matrix based on the first observation data and the first state parameters; determining a first measurement update matrix and a first measurement variance matrix corresponding to the first observation residual matrix; and determining the model validation parameter value corresponding to the first filter based on the first observation residual matrix, the first measurement update matrix, the first measurement variance matrix, and the first state covariance matrix. The manner of obtaining the first observation residual matrix, the first measurement update matrix, the first measurement variance matrix, and the first state covariance matrix will be described later, and will not be repeated here.
[0101] Exemplarily, the first observation data includes at least one of first pseudorange observation data and first Doppler observation data. If the first observation data includes the first pseudorange observation data, the first observation residual matrix includes a first pseudorange observation residual matrix, the first measurement update matrix includes a first pseudorange measurement update matrix, the first measurement variance matrix includes a first pseudorange measurement variance matrix, and the model validation parameter value corresponding to the first filter includes a pseudorange model validation parameter value, which is determined based on the first pseudorange measurement update matrix, the first pseudorange measurement variance matrix, the first state covariance matrix, and the first pseudorange observation residual matrix. Exemplarily, the pseudorange model validation parameter value is calculated and obtained based on Equation 5. TIFF2024543946000061.tif8170, where TIFF2024543946000062.tif5170 represents the pseudorange model validation parameter values, TIFF2024543946000063.tif5170 represents the first state covariance matrix, TIFF2024543946000064.tif5170 represents the first pseudorange observation residual matrix, TIFF2024543946000065.tif5170 represents the transpose of the first pseudorange observation residual matrix, TIFF2024543946000066.tif5170 represents the first pseudorange measurement covariance matrix, TIFF2024543946000067.tif5170 represents a first pseudorange measurement update matrix, which is a Jacobian matrix. A Jacobian matrix is a matrix obtained by arranging first-order partial differentials in a certain manner; TIFF2024543946000068.tif6170 represents the transpose of the first pseudorange measurement update matrix.
[0102] When the first observation data includes first Doppler observation data, the first observation residual matrix includes a first Doppler observation residual matrix, the first measurement update matrix includes a first Doppler measurement update matrix, the first measurement variance matrix includes a first Doppler measurement variance matrix, and the model validation parameter value corresponding to the first filter includes a Doppler model validation parameter value, which is determined based on the first Doppler measurement update matrix, the first Doppler measurement variance matrix, the first state covariance matrix, and the first Doppler observation residual matrix. Illustratively, the Doppler model validation parameter value is calculated and obtained based on Equation 6. TIFF2024543946000069.tif8170, where TIFF2024543946000070.tif5170 represents the Doppler model validation parameter values, TIFF2024543946000071.tif5170 represents the first state covariance matrix, TIFF2024543946000072.tif5170 represents the first Doppler observation residual matrix, TIFF2024543946000073.tif5170 represents the transpose of the first Doppler observation residual matrix, TIFF2024543946000074.tif5170 represents the first Doppler measurement covariance matrix, TIFF2024543946000075.tif5170 represents the first Doppler measurement update matrix, TIFF2024543946000076.tif6170 represents the transpose of the first Doppler measurement update matrix.
[0103] In an exemplary embodiment, the process of determining model validation parameter values corresponding to the first filter based on the first observation data, the first state parameters, and the first state covariance matrix is performed when it is determined that there is no jump in the first filter, and if there is a jump in the first filter, the jump in the first filter is repaired, and then the subsequent operation, i.e., the process of determining model validation parameter values corresponding to the first filter, is performed.
[0104] For example, the existence of a jump in the first filter may mean that at least one of a clock bias jump and a clock drift jump exists in the first filter. In this case, before performing model verification on the first filter, a clock bias detection and a clock drift detection are performed first, and if it is detected that the clock bias jump and / or the clock drift jump exists in the first filter, the clock bias jump and / or the clock drift jump is repaired on the first filter, i.e., the first state parameter and the first state covariance parameter of the first filter are updated (also referred to as resetting the first filter); if it is detected that the clock bias jump and the clock drift jump do not exist in the first filter, the first state parameter and the first state covariance matrix of the first filter are kept as they are.
[0105] In an exemplary embodiment, if the first pseudorange observation residual matrix satisfies the relationship shown in Equation 7 below, the method shown in Equation 8 below can be used to detect clock bias jumps for the first filter. TIFF2024543946000077.tif37170, where TIFF2024543946000078.tif5170 is the first pseudorange observation residual matrix represents the median absolute deviation of TIFF2024543946000079.tif5170, TIFF2024543946000080.tif5170 is the first pseudorange observation residual matrix This represents the median of TIFF2024543946000081.tif5170. TIFF2024543946000082.tif5170 is the first pseudorange observation residual matrix TIFF2024543946000083.tif5170 represents the standard deviation, TIFF2024543946000084.tif5170 is the first pseudorange observation residual matrix TIFF2024543946000085.tif represents the average of 5170 TIFF2024543946000086.tif5170 and TIFF2024543946000087.tif5170 is the clock bias detection threshold, TIFF2024543946000088.tif5170 is the first state covariance matrix TIFF2024543946000089.tif, line 5170 TIFF2024543946000090.tif represents 5170 columns of elements, TIFF2024543946000091.tif5170 is the clock bias jump value, TIFF2024543946000092.tif12170 represents the clock bias detection value.
[0106] If TIFF2024543946000093.tif5170 is 0, it means that there is no clock bias jump in the first filter. If TIFF2024543946000094.tif5170 is equal to 1, it indicates that there is a clock bias jump in the first filter, and the clock bias jump can be repaired and the filter reset in the manner shown in Equation 9 below, that is, the first state parameter and the first state covariance matrix of the first filter can be set again. TIFF2024543946000095.tif17170, where TIFF2024543946000096.tif5170 represents the position of the clock bias in the first state parameter x(t), TIFF2024543946000097.tif5170 is the first state parameter TIFF2024543946000098.tif represents an element at position 5170, TIFF2024543946000099.tif5170 is the first state covariance matrix TIFF2024543946000100.tif represents the element in row 5170 and column t. TIFF2024543946000101.tif5170 is the t-th row of the first state covariance matrix TIFF2024543946000102.tif5170 represents an element of the column, where t is a value from 1 to h, and h (an integer equal to or greater than 1) represents the number of columns of the first state covariance matrix. TIFF2024543946000103.tif5170 represents the first pseudorange observation residual matrix, TIFF2024543946000104.tif5170 is the first state covariance matrix TIFF2024543946000105.tif5170th line TIFF2024543946000106.tif5170 represents an element of column 170, and SQR(100.0) represents opening 100.
[0107] Similar to the above clock bias jump detection process, the first Doppler observation residual matrix The clock drift jump is detected and repaired according to TIFF2024543946000107.tif5170, and the clock drift jump detection method is the same as the clock bias jump detection method in principle, and will not be described again here.
[0108] If a clock drift jump is detected, the clock drift jump can be repaired and the filter can be reset in the manner shown in Equation 10 below, that is, the first state parameters and the first state covariance matrix of the first filter can be set anew. TIFF2024543946000108.tif18170, where TIFF2024543946000109.tif5170 represents the position of the clock drift in the first state parameter x(t), TIFF2024543946000110.tif5170 is the first state parameter TIFF2024543946000111.tif represents an element at position 5170, TIFF2024543946000112.tif5170 is the first state covariance matrix TIFF2024543946000113.tif represents the element in row 5170 and column t. TIFF2024543946000114.tif5170 is the first state covariance matrix TIFF2024543946000115.tif4170th line TIFF2024543946000116.tif represents 5170 columns of elements, TIFF2024543946000117.tif5170 represents the first Doppler observation residual matrix, and is illustratively TIFF2024543946000118.tif5170 is the Doppler observation residual matrix without gross error, TIFF2024543946000119.tif9170 is the first Doppler observation residual matrix This represents the median of TIFF2024543946000120.tif5170. TIFF2024543946000121.tif5170 is the first state covariance matrix TIFF2024543946000122.tif5170th line Represents an element of the TIFF2024543946000123.tif5170 column. For the meaning of other parameters, see formula 9.
[0109] In step b, in response to the model verification parameter value being smaller than a first threshold, a test result of the observation sub-data in the first observation data is obtained, and in response to all of the test results of the observation sub-data in the first observation data satisfying the retention condition, it is determined that the first observation data satisfies the first selection condition.
[0110] For example, for a situation where the model validation parameter value includes a pseudorange model validation parameter value and a Doppler model validation parameter value, the first threshold value includes a pseudorange model validation parameter threshold value and a Doppler model validation parameter threshold value, and the model validation parameter value is smaller than the first threshold value means that the pseudorange model validation parameter value is smaller than the pseudorange model validation parameter threshold value and the Doppler model validation parameter value is smaller than the Doppler model validation parameter threshold value. The pseudorange model validation parameter threshold value and the Doppler model validation parameter threshold value are set based on experience or flexibly adjusted according to application scenarios, and the embodiments of the present application are not limited thereto. The pseudorange model validation parameter threshold value and the Doppler model validation parameter threshold value may be the same or different.
[0111] In an example embodiment, the pseudorange model validation parameter value may be greater than or equal to the pseudorange model validation parameter threshold, which requires the first filter to be reset.In an example embodiment, the Doppler model validation parameter value may be greater than or equal to the Doppler model validation parameter threshold, which also requires the first filter to be reset.
[0112] In one possible implementation manner, the process of obtaining a test result of the observation sub-data in the first observation data includes the steps of: performing a normalization process on the first observation residual matrix based on the first measurement update matrix, the first measurement variance matrix, and the first state covariance matrix to obtain a normalized residual matrix; testing the normalized residual matrix, one of whose elements is associated with one observation sub-data in the first observation data, based on a second residual covariance matrix constructed based on the first measurement update matrix, the first measurement variance matrix, and the first state covariance matrix to obtain a test result corresponding to each element in the normalized residual matrix; and setting the test results corresponding to each element in the normalized residual matrix as the test result of the corresponding observation sub-data in the first observation data, up to this point, the test result of the observation sub-data in the first observation data is obtained.
[0113] For example, the first observation data includes first pseudorange observation data and first Doppler observation data, the first pseudorange observation data includes one or more pseudorange observation sub-data, and the first Doppler observation data includes one or more Doppler observation sub-data. In this case, the normalized residual matrix includes a normalized pseudorange residual matrix and a normalized Doppler residual matrix. Any element in the normalized pseudorange residual matrix is associated with one pseudorange observation sub-data in the first pseudorange observation data, and any element in the normalized Doppler residual matrix is associated with one Doppler observation sub-data in the first Doppler observation data. In this case, the test results corresponding to each element in the normalized pseudorange residual matrix are the test results of the corresponding pseudorange observation sub-data in the first pseudorange observation data, and the test results corresponding to each element in the normalized Doppler residual matrix are the test results of the corresponding Doppler observation sub-data in the first Doppler observation data.
[0114] Exemplarily, the normalized pseudorange residual matrix and the normalized Doppler residual matrix may be calculated and obtained based on Equation 11 and Equation 12, respectively. TIFF2024543946000124.tif21170, where TIFF2024543946000125.tif5170 represents the normalized pseudorange residual matrix, TIFF2024543946000126.tif5170 represents the first state covariance matrix, TIFF2024543946000127.tif5170 represents the first pseudorange observation residual matrix, TIFF2024543946000128.tif5170 represents the first pseudorange measurement covariance matrix, TIFF2024543946000129.tif5170 represents the first pseudorange measurement update matrix; TIFF2024543946000130.tif6170 represents the transpose of the first pseudorange measurement update matrix, TIFF2024543946000131.tif5170 represents the normalized Doppler residual matrix, TIFF2024543946000132.tif5170 represents the first Doppler observation residual matrix, TIFF2024543946000133.tif5170 represents the first Doppler measurement covariance matrix, TIFF2024543946000134.tif5170 represents the first Doppler measurement update matrix, TIFF2024543946000135.tif6170 represents the transpose of the first Doppler measurement update matrix.
[0115] The second residual covariance matrix includes a second pseudorange residual covariance matrix and a second Doppler residual covariance matrix. The process of calibrating the normalized residual matrix based on the second residual covariance matrix and obtaining a calibration result corresponding to each element in the normalized residual matrix includes: calibrating the normalized pseudorange residual matrix based on the second pseudorange residual covariance matrix and obtaining a calibration result corresponding to each element in the normalized pseudorange residual matrix; and calibrating the normalized Doppler residual matrix based on the second Doppler residual covariance matrix and obtaining a calibration result corresponding to each element in the normalized Doppler residual matrix.
[0116] For example, the test result corresponding to the i-th element in the normalized pseudorange residual matrix (i.e., the test result corresponding to the i-th pseudorange observation sub-data in the first pseudorange observation data) is obtained by calculation based on Equation 13, and the test result corresponding to the i-th element in the normalized Doppler residual matrix (i.e., the test result corresponding to the i-th Doppler observation sub-data in the first Doppler observation data) is obtained by calculation based on Equation 14. TIFF2024543946000136.tif35170, where TIFF2024543946000137.tif5170 is the normalized pseudorange residual matrix represents the i-th element in TIFF2024543946000138.tif5170, where i is a positive integer equal to or less than the number of pseudorange observation subdata in the first pseudorange observation data, TIFF2024543946000139.tif5170 is the normalized pseudorange residual matrix This represents the test result corresponding to the i-th element in TIFF2024543946000140.tif5170. TIFF2024543946000141.tif7170 represents the second pseudorange residual covariance matrix, TIFF2024543946000142.tif9170 represents the element in the i-th row and i-th column of the second pseudorange residual covariance matrix.
[0117] TIFF2024543946000143.tif5170 is the normalized Doppler residual matrix represents the i-th element in TIFF2024543946000144.tif5170, where i is a positive integer equal to or less than the number of Doppler observation sub-data in the first Doppler observation data, TIFF2024543946000145.tif5170 is the normalized Doppler residual matrix This represents the test result corresponding to the i-th element in TIFF2024543946000146.tif5170. TIFF2024543946000147.tif7170 represents the second Doppler residual covariance matrix, TIFF2024543946000148.tif9170 represents the element in the i-th row and i-th column of the second Doppler residual covariance matrix.
[0118] In an exemplary embodiment, the test result of any of the observation sub-data in the first observation data satisfies the hold condition, which means that the test result of any of the observation sub-data is equal to or less than the corresponding threshold. If any of the observation sub-data is any of the pseudo-range observation sub-data, the test result of any of the observation sub-data satisfies the hold condition, which means that the test result of any of the pseudo-range observation sub-data is equal to or less than the first test threshold, and if any of the observation sub-data is any of the Doppler observation sub-data, the test result of any of the observation sub-data satisfies the hold condition, which means that the test result of any of the Doppler sub-data is equal to or less than the second test threshold. The first test threshold and the second test threshold are set based on experience or flexibly adjusted according to application scenarios, and the embodiment of the present application is not limited thereto. The first test threshold and the second test threshold may be the same or different.
[0119] If the test results of each observation sub-data in the first observation data all satisfy the retention condition, i.e., if the test results of each pseudorange observation sub-data in the first pseudorange observation data are all below the first test threshold and the test results of each Doppler observation sub-data in the first Doppler observation data are all below the second test result, it is determined that the first observation data satisfies the first selection condition.
[0120] Exemplarily, if the test result of each observation sub-data in the first observation data does not satisfy the retention condition, it is determined that the first observation data does not satisfy the first screening condition. The observation sub-data whose test result does not satisfy the retention condition are removed to obtain second observation data, and then a subsequent operation is performed based on the second observation data, that is, the first positioning result is corrected based on the second observation data. Exemplarily, the process of removing the observation sub-data whose test result does not satisfy the retention condition can be regarded as a process of removing gross errors of satellite data causing divergence of the first filter from the first observation data by detecting gross errors for the first observation data based on the first observation residual matrix and a normal distribution test.
[0121] It should be noted that the above-mentioned manner of determining whether the first observation data satisfies the first screening condition is merely an illustrative description, and the embodiments of the present application are not limited thereto. For example, the first observation data may be determined to satisfy the first screening condition in response to the model validation parameter being smaller than a first threshold. Furthermore, the test results of the observation sub-data in the first observation data are directly obtained, and the first observation data is determined to satisfy the first screening condition in response to the test results of the observation sub-data in the first observation data all satisfying the retention condition.
[0122] In step 5013, a first parameter increment is determined based on the first observation residual matrix, the first measurement update matrix, the first measurement variance matrix, and the first state covariance matrix, and the sum of the first parameter increment and the first state parameter is set as the first state parameter after the update of the first filter.
[0123] Exemplarily, the first parameter increment includes at least one of a first pseudorange state parameter increment and a first Doppler state parameter increment. In the embodiment of the present application, the first parameter increment includes a first pseudorange parameter increment and a first Doppler parameter increment, and in this case, the updated first state parameter includes an updated first pseudorange state parameter and an updated first Doppler state parameter.
[0124] Exemplarily, the updated first pseudorange state parameter is obtained by calculation based on the following Equation 15. TIFF2024543946000149.tif14170, where TIFF2024543946000150.tif5170 represents the first pseudorange state parameters after the update, TIFF2024543946000151.tif5170 represents the first pseudorange state parameter; TIFF2024543946000152.tif5170 represents the first state covariance matrix, TIFF2024543946000153.tif5170 represents the first pseudorange measurement update matrix; TIFF2024543946000154.tif6170 represents the transpose of the first pseudorange measurement update matrix, TIFF2024543946000155.tif6170 represents the first pseudorange measurement covariance matrix, TIFF2024543946000156.tif5170 represents the first pseudorange observation residual matrix, TIFF2024543946000157.tif9170 represents the first pseudorange parameter increment. TIFF2024543946000158.tif5170 may represent the pseudorange filter gain.
[0125] Exemplarily, the updated first Doppler state parameter is obtained by calculation based on the following Equation 16. TIFF2024543946000159.tif14170, where TIFF2024543946000160.tif5170 represents the first Doppler state parameters after the update, TIFF2024543946000161.tif5170 represents the first Doppler state parameters, TIFF2024543946000162.tif5170 represents the first state covariance matrix, TIFF2024543946000163.tif5170 represents the first Doppler measurement update matrix, TIFF2024543946000164.tif6170 represents the transpose of the first Doppler measurement update matrix, TIFF2024543946000165.tif6170 represents the first Doppler measurement covariance matrix, TIFF2024543946000166.tif5170 represents the first Doppler observation residual matrix, TIFF2024543946000167.tif9170 represents the first Doppler parameter increment. TIFF2024543946000168.tif5170 can represent the Doppler filter gain.
[0126] In step 5014, in response to the updated first state parameter satisfying the first criterion condition, a first correction result is obtained based on the updated first state parameter.
[0127] The types of parameters included in the updated first state parameters cover the types of parameters that need to be included in the positioning results of the mobile device, and after obtaining the updated first state parameters, parameters whose types are the types of parameters that need to be included in the positioning results of the mobile device are extracted from the updated first state parameters to construct a first correction result.
[0128] Exemplarily, the process of determining that the updated first state parameter satisfies the first criterion condition includes the steps of: determining a covariance increment based on the first measurement update matrix, the first measurement variance matrix, and the first state covariance matrix; and determining the product of the covariance increment and the first state covariance matrix as the updated first state covariance matrix; detecting a correction amount for the first parameter increment based on the updated first state covariance matrix; and in response to the detection of the correction amount being successful, testing the first observation residual matrix based on the updated first state covariance matrix, the first measurement variance matrix, and the first residual covariance matrix constructed based on the first measurement update matrix to obtain a test result corresponding to each element in the first observation residual matrix; and in response to the test results corresponding to each element in the first observation residual matrix all satisfying the test condition, determining that the updated first state parameter satisfies the first criterion condition.
[0129] Exemplarily, the covariance increment may include at least one of a pseudorange covariance increment and a Doppler covariance increment. Exemplarily, if the covariance increment includes a pseudorange covariance increment, the updated first state covariance matrix may be obtained by calculation based on Equation 17. TIFF2024543946000169.tif8170, where TIFF2024543946000170.tif5170 represents the first state covariance matrix after the update, TIFF2024543946000171.tif5170 represents the first state covariance matrix, I represents the identity matrix, and for the meaning of the other parameters, see Equation 15.
[0130] Exemplarily, if the covariance increment includes a Doppler covariance increment, the updated first state covariance matrix may be obtained by calculation based on Equation 18. TIFF2024543946000172.tif8170, where TIFF2024543946000173.tif5170 represents the first state covariance matrix after the update, TIFF2024543946000174.tif5170 represents the first state covariance matrix, TIFF2024543946000175.tif4170 represents the identity matrix; for the meaning of the other parameters, see Equation 16.
[0131] Exemplarily, if the first parameter increment is a first pseudorange parameter increment, the process of detecting a correction amount for the first parameter increment based on the updated first state covariance matrix includes: and determining that the detection of the correction amount of the first pseudorange parameter increment is successful if the measurement indexes corresponding to the elements of the first pseudorange parameter increment are all equal to or less than the first index threshold value, where: TIFF2024543946000177.tif5170 is the first pseudorange parameter increment represents the i-th element in TIFF2024543946000178.tif4170, TIFF2024543946000179.tif5170 represents the element in the i-th row and i-th column of the updated first state covariance matrix. As can be seen from Equation 15, the first pseudorange parameter increment The file is TIFF2024543946000180.tif9170.
[0132] Exemplarily, if the first parameter increment is a first Doppler parameter increment, the process of detecting a correction amount for the first parameter increment based on the updated first state covariance matrix can include: and determining that the detection of the correction amount of the first Doppler parameter increment is successful if the value of TIFF2024543946000181.tif11170 is a measurement index corresponding to the i-th element in the first Doppler parameter increment, and if all of the measurement indexes corresponding to the elements in the first Doppler parameter increment are equal to or less than the second index threshold, TIFF2024543946000182.tif5170 is the first Doppler parameter increment represents the i-th element in TIFF2024543946000183.tif4170, TIFF2024543946000184.tif5170 represents the element in the i-th row and i-th column of the updated first state covariance matrix. As can be seen from Equation 16, the first Doppler parameter increment The file is TIFF2024543946000185.tif9170.
[0133] For example, if the detection of the correction amount of the first pseudorange parameter increment and the first Doppler parameter increment both passes, the detection of the correction amount is deemed to pass. If the detection of the first pseudorange parameter increment and / or the first Doppler parameter increment does not pass, the detection of the correction amount is deemed to fail, and in this case, the first filter needs to be reset.
[0134] After determining that the detection of the correction amount is successful, a first residual covariance matrix is constructed based on the updated first state covariance matrix, the first measurement variance matrix and the first measurement update matrix, and a first observation residual matrix is validated based on the first residual covariance matrix to obtain a validation result respectively corresponding to each element in the first observation residual matrix.
[0135] For example, the first residual covariance matrix includes a first pseudorange residual covariance matrix and a first Doppler residual covariance matrix, and the first observation residual matrix includes a first pseudorange observation residual matrix and a first Doppler observation residual matrix. Illustratively, the first observation residual matrix may be referred to as a calibrated observation residual matrix.
[0136] Exemplarily, the test result of the i-th element in the first pseudorange observation residual matrix is obtained by calculation according to Equation 19. TIFF2024543946000186.tif21170, where TIFF2024543946000187.tif4170 represents the test result of the i-th element in the first pseudorange observation residual matrix, TIFF2024543946000188.tif5170 represents the first pseudorange measurement update matrix; TIFF2024543946000189.tif6170 represents the transpose of the first pseudorange measurement update matrix, TIFF2024543946000190.tif6170 represents the first pseudorange measurement covariance matrix, TIFF2024543946000191.tif5170 represents the first state covariance matrix after the update, TIFF2024543946000192.tif6170 represents the i-th element in the first pseudorange observation residual matrix, where i is an integer equal to or less than the number of elements in the first pseudorange observation residual matrix; TIFF2024543946000193.tif9170 represents the first pseudorange residual covariance matrix, TIFF2024543946000194.tif11170 represents the element in the i-th row and i-th column of the first pseudorange residual covariance matrix.
[0137] Exemplarily, the test result of the i-th element in the first Doppler observation residual matrix is obtained by calculation according to Equation 20. TIFF2024543946000195.tif22170, where TIFF2024543946000196.tif4170 represents the test result of the i-th element in the first Doppler observation residual matrix. TIFF2024543946000197.tif5170 represents the first Doppler measurement update matrix, TIFF2024543946000198.tif6170 represents the transpose of the first Doppler measurement update matrix, TIFF2024543946000199.tif6170 represents the first Doppler measurement covariance matrix, TIFF2024543946000200.tif5170 represents the first state covariance matrix after the update, TIFF2024543946000201.tif7170 represents the i-th element in the first Doppler observation residual matrix, where i is an integer equal to or less than the number of elements in the first Doppler observation residual matrix; TIFF2024543946000202.tif9170 represents the first Doppler residual covariance matrix, TIFF2024543946000203.tif11170 represents the element in the i-th row and i-th column of the first Doppler residual covariance matrix.
[0138] Exemplarily, the test result corresponding to a certain element satisfies the test condition, which means that the test result of the element is smaller than the corresponding threshold. Exemplarily, the test results corresponding to each element in the first observation residual matrix all satisfy the test condition, which means that the test results corresponding to each element in the first pseudorange observation residual matrix all are smaller than the first target threshold, and the test results corresponding to each element in the first Doppler observation residual matrix all are smaller than the second target threshold. The first target threshold and the second target threshold are set based on experience, or flexibly adjusted according to the application scene. The first target threshold and the second target threshold may be the same or different.
[0139] When it is determined that all of the test results corresponding to the elements in the first observation residual matrix satisfy the test condition, it is determined that the updated first state parameters satisfy the first reference condition.
[0140] In an exemplary embodiment, if the test result corresponding to an element does not satisfy the test condition, it is determined that the updated first state parameter does not satisfy the first criteria condition, and the observation sub-data associated with the element is removed from the first observation data to obtain filtered observation data, and subsequent operations are performed based on the filtered observation data, i.e., the first positioning result is corrected based on the filtered observation data.
[0141] It should be noted that the above-mentioned method of determining whether the updated first state parameter satisfies the first criterion condition is merely an illustrative description, and the embodiments of the present application are not limited thereto. In some embodiments, the updated first state parameter may be considered to satisfy the first criterion condition if the correction amount detection is passed. In some embodiments, the correction amount detection may not be performed, and only the test results corresponding to each element in the first observation residual matrix may be obtained, and the updated first state parameter may be determined to satisfy the first criterion condition only if all the test results corresponding to each element in the first observation residual matrix satisfy the test condition.
[0142] For example, the relevant processing process of the first filter can be referred to in Fig. 6. The first filter is initialized, the initialized first filter is time updated, and the first filter after the time update is measured and updated. In the process of measuring and updating the first filter after the time update, the first filter is first subjected to detection and repair of clock bias jump and clock drift jump, and then gross errors are detected based on normal distribution testing, and the first filter is subjected to model verification and repair based on the observation data from which gross errors have been removed. After the model verification and repair, the update decomposition verification and repair for the first filter is completed by detecting the correction amount and testing the verified observation residual matrix.
[0143] In step 502, the first correction result is corrected using the double difference observation data to obtain a second correction result, and the second correction result is set as the target positioning result.
[0144] The second correction result is obtained by correcting the first correction result using double difference observation data, and is more reliable than the first correction result. After obtaining the second correction result, the second correction result is set as the target positioning result of the mobile device, which is advantageous to ensure the reliability of the target positioning result and improve the positioning accuracy and positioning robustness of the target positioning result.
[0145] In one possible implementation manner, the process of correcting the first correction result using double difference observation data to obtain the second correction result may be realized by using a second filter. As shown in Fig. 5, the process of correcting the first correction result using double difference observation data to obtain the second correction result includes the following steps 5021 to 5024.
[0146] In step 5021, second state parameters of a second filter are determined based on the first correction result, and a second state covariance matrix corresponding to the second state parameters is obtained.
[0147] The second filter is a filter for correcting the first correction result using double difference observation data, and the type of the second filter may include, but is not limited to, a Kalman filter, an extended Kalman filter, an unscented Kalman filter, a robust Kalman filter, etc., and the embodiments of the present application are not limited thereto.
[0148] The second state parameter is a state parameter to be updated that the second filter has, and illustratively, the type of the parameter in the state parameter of the second filter includes the type of the parameter in the positioning result of the mobile device, for example, the location type. Exemplarily, the double difference observation data includes the carrier phase observation data, and the type of the parameter in the state parameter of the second filter further includes the type of the integer bias. The integer bias is also called integer ambiguity, and is an integer ambiguity corresponding to the first observation value of the phase difference between the carrier phase and the reference phase during the carrier phase measurement of the global positioning system technology.
[0149] In an exemplary embodiment, the manner of obtaining the second state parameter of the second filter based on the first correction result may be to set the state parameter including the position of the first positioning result and the initial value of the integer bias as the second state parameter. In an exemplary embodiment, the manner of obtaining the second state parameter of the second filter based on the first correction result may be to set the state parameter including the position of the first positioning result and the initial value of the integer bias as the second initial state parameter, and perform time update on the second initial state parameter to obtain the second state parameter.
[0150] The second state covariance matrix may characterize the correlation between the second state parameters, and the second state covariance matrix is a diagonal matrix and is also a symmetric matrix. Exemplarily, in a situation where the state parameters including the position of the first positioning result and the initial value of the integer bias are set as the second state parameters, the second state covariance matrix may be set based on experience. Exemplarily, in a situation where the state parameters including the position of the first positioning result and the initial value of the integer bias are set as the second initial state parameters, and the second initial state parameters are time-updated to obtain the second state parameters, the manner of obtaining the second state covariance matrix corresponding to the second state parameters may be to obtain a second initial state covariance matrix corresponding to the second initial state parameters, time-update the second initial covariance matrix, and set the covariance matrix obtained by time-updating as the second state covariance matrix corresponding to the second state parameters.
[0151] In step 5022, in response to the double-differenced observed data satisfying the second screening condition, a double-differenced observed residual matrix is obtained based on the double-differenced observed data and the second state parameters, and a double-differenced measurement update matrix and a double-differenced measurement variance matrix corresponding to the double-differenced observed residual matrix are determined.
[0152] The double-differenced observation data satisfying the second screening condition indicates that the double-differenced observation data is reliable and can be directly used to update the second state parameters. In the process of updating the second state parameters using the double-differenced observation data, it is first necessary to obtain a double-differenced observation residual matrix based on the double-differenced observation data and the second state parameters, and then determine a double-differenced measurement update matrix and a double-differenced measurement variance matrix corresponding to the double-differenced observation residual matrix. The double-differenced measurement variance matrix, the double-differenced measurement update matrix, and the double-differenced observation residual matrix are matrices required for updating the second state parameters of the second filter, which are determined based on the double-differenced observation data and the second state parameters.
[0153] In one possible implementation manner, the process of obtaining a double-differenced observed residual matrix based on the double-differenced observed data and the second state parameters includes: obtaining double-differenced estimated data based on the second state parameters; and constructing a double-differenced observed residual matrix based on the double-differenced observed data and the double-differenced estimated data.
[0154] For example, when the double difference observation data includes pseudorange double difference observation data and carrier phase double difference observation data, the double difference estimation data includes pseudorange double difference estimation data and carrier phase double difference estimation data. Of course, the double difference observation data may be in other situations, and the situation of the double difference estimation data changes with the change of the situation of the double difference observation data. For example, when the double difference observation data only includes pseudorange double difference observation data, the double difference estimation data only includes pseudorange double difference estimation data, and when the double difference observation data only includes carrier phase double difference observation data, the double difference estimation data only includes carrier phase double difference estimation data.
[0155] For example, the pseudorange double difference estimation data includes pseudorange double difference estimation values corresponding to each other satellite other than the reference satellite among the first satellites, and the carrier phase double difference estimation data includes carrier phase double difference estimation values corresponding to each other satellite. The pseudorange double difference estimation value corresponding to any other satellite and the carrier phase double difference estimation value corresponding to any other satellite are both obtained based on the difference value between the first distance difference value and the second distance difference value corresponding to the any other satellite.
[0156] The first distance difference value corresponding to any other satellite means a difference value between a geometric distance between the reference satellite and the mobile device and a geometric distance between the any other satellite and the mobile device, and the second distance difference value corresponding to any other satellite means a difference value between a geometric distance between the reference satellite and the reference station and a geometric distance between the any other satellite and the reference station. The geometric distance between the satellite and the mobile device may be obtained by calculation based on a position in the status information of the satellite and a position in the second status parameter, and the geometric distance between the satellite and the reference station may be obtained by calculation based on a position in the status information of the satellite and a position of the reference station.
[0157] After obtaining the double-difference observation data and the double-difference estimation data, a double-difference observation residual matrix is constructed according to the double-difference observation data and the double-difference estimation data. Illustratively, the double-difference observation data includes pseudorange double-difference observation data and carrier-phase double-difference observation data, and the double-difference estimation data includes pseudorange double-difference estimation data and carrier-phase double-difference estimation data, in this case, the process of constructing a double-difference observation residual matrix according to the double-difference observation data and the double-difference estimation data includes the following steps: construct a pseudorange double-difference observation residual matrix according to the pseudorange double-difference observation data and the pseudorange double-difference estimation data; construct a carrier-phase double-difference observation residual matrix according to the carrier-phase double-difference observation data and the carrier-phase double-difference estimation data; and the matrix composed of the pseudorange double-difference observation residual matrix and the carrier-phase double-difference observation residual matrix is the double-difference observation residual matrix.
[0158] Illustratively, the constructing equations of the pseudorange double-difference observation residual matrix and the carrier-phase double-difference observation residual matrix are shown in Equation 21 and Equation 22, respectively. TIFF2024543946000204.tif46170, where TIFF2024543946000205.tif5170 represents the pseudorange double difference residual matrix, TIFF2024543946000206.tif5170 represents the carrier phase double difference residual matrix, TIFF2024543946000207.tif5170 represents a geometric distance between a first satellite i (i=1, 2, ..., n) and a mobile device, where n (an integer equal to or greater than 2) is the number of first satellites; TIFF2024543946000208.tif5170 represents the geometric distance between the first satellite i and the reference station, where the first satellite 1 is the reference satellite. TIFF2024543946000209.tif5170 represents the pseudorange double difference observation corresponding to the first satellite, TIFF2024543946000210.tif5170 represents a carrier phase double difference observation corresponding to the first satellite 2, and so on. TIFF2024543946000211.tif5170 represents double difference ionospheric delay, TIFF2024543946000212.tif5170 represents double difference tropospheric delay, TIFF2024543946000213.tif6170 represents the integer bias, where the integer bias is an integer, TIFF2024543946000214.tif4170 represents the carrier wavelength. The double difference ionospheric delay and the double difference tropospheric delay may be set based on experience, and the embodiment of the present application is not limited thereto. When constructing the double difference observation residual matrix, the integer value bias may be initialized based on experience.
[0159] After the pseudorange double difference observation residual matrix and the carrier phase double difference observation residual matrix are obtained, the pseudorange double difference observation residual matrix and the carrier phase double difference observation residual matrix are combined to obtain the double difference observation residual matrix Get TIFF2024543946000215.tif9170.
[0160] After obtaining the double-differenced observation residual matrix, a double-differenced measurement update matrix and a double-differenced measurement variance matrix corresponding to the double-differenced observation residual matrix are determined. Exemplarily, the double-differenced measurement variance matrix may be constructed based on experience, or may be constructed based on the signal-to-noise ratio of the double-differenced observation data and the state information of the satellites that are the subject of the double-differenced observation data. Exemplarily, the double-differenced measurement update matrix may be a coefficient in a differential constraint equation constructed based on the double-differenced observation residual matrix. Exemplarily, the differential constraint equation is a double-differenced observation residual matrix TIFF2024543946000216.tif9170 and the given increment matrix TIFF2024543946000217.tif4170. Exemplarily, the differential constraint equation may be referred to as a Kalman correction equation, an RTK differential constraint correction equation, etc. Exemplarily, the differential constraint equation is shown in Equation 23. TIFF2024543946000218.tif9170, where TIFF2024543946000219.tif4170 is the coefficient of the differential constraint equation (i.e., the double-differenced measurement update matrix), and H means the Jacobian matrix for the second state parameter of the double-differenced observation residual matrix. Illustratively, the formula for H is shown in Equation 24. TIFF2024543946000220.tif40170, where TIFF2024543946000221.tif5170 represents a unit observation vector from the mobile device to a first satellite s (s=1, 2, ..., n), and λ represents the carrier wavelength.
[0161] In an exemplary embodiment, a method for determining whether the double-differenced observation data satisfies the second selection condition may be to detect a gross error in the double-differenced observation residual matrix, and if the detection result indicates that no data to be removed exists in the double-differenced observation data, to determine that the double-differenced observation data satisfies the second selection condition. Exemplarily, a method for detecting a gross error in the double-differenced observation residual matrix may be to detect a gross error in the double-differenced observation residual matrix based on a quartile, or to detect a gross error in the double-differenced observation residual matrix based on a median absolute deviation, and the embodiment of the present application is not limited thereto.
[0162] In step 5023, a second parameter increment is determined based on the double-differenced observation residual matrix, the double-differenced measurement update matrix, the double-differenced measurement variance matrix, and the second state covariance matrix, and the sum of the second parameter increment and the second state parameter is the second state parameter after the update of the second filter.
[0163] The second parameter increment is an increment for updating the second state parameter. Illustratively, the process of determining the second parameter increment based on the double-differenced observation residual matrix, the double-differenced measurement update matrix, the double-differenced measurement variance matrix, and the second state covariance matrix is implemented according to Equation 25. TIFF2024543946000222.tif12170, where TIFF2024543946000223.tif5170 represents the second parameter increment, TIFF2024543946000224.tif5170 represents a second state covariance matrix, which represents the relationship between each parameter in the second state parameters and may be set based on experience; TIFF2024543946000225.tif5170 represents the Kalman gain, TIFF2024543946000226.tif5170 represents the double difference measurement covariance matrix, H represents the double difference measurement update matrix, and H T represents the transpose of the double difference measurement update matrix, TIFF2024543946000227.tif9170 represents the doubly-differenced observation residual matrix.
[0164] In an example embodiment, the second state covariance matrix may be updated based on the Kalman gain and the double difference measurement update matrix, where the update scheme is as shown in Equation 26. TIFF2024543946000228.tif6170, where TIFF2024543946000229.tif5170 represents the updated second state covariance matrix, and for the meanings of other parameters, see Equation 25.
[0165] In an exemplary embodiment, the process of determining whether the corrected parameter matrix satisfies the specified condition may be to determine that the corrected parameter matrix satisfies the specified condition if the corrected parameter matrix converges.
[0166] In step 5024, in response to the updated second state parameter satisfying the second reference condition, a second correction result is obtained based on the updated second state parameter.
[0167] In an exemplary embodiment, the process of determining whether the updated second state parameters satisfy the second criterion condition may be to test the correction amount for the verified double difference observation residual matrix, and if the correction amount test passes, perform a normal distribution test on the verified pseudorange double difference observation residual matrix and the verified carrier phase double difference observation residual matrix, respectively. If both the verified pseudorange double difference observation residual matrix and the verified carrier phase double difference observation residual matrix pass the normal distribution test, it is determined that the updated second state parameters satisfy the second criterion condition. Illustratively, if the verified pseudorange double difference observation residual matrix and / or the verified carrier phase double difference observation residual matrix do not pass the normal distribution test, it is determined that the updated second state parameters do not satisfy the second criterion condition, and it is necessary to remove data related to the pseudorange observation values and / or carrier phase observation values that do not pass the normal distribution test from the double difference observation data.
[0168] Illustratively, the verified double-difference observation residual matrix is a double-difference observation residual matrix obtained based on the updated second state parameters and the double-difference observation data. The pseudorange double-difference observation residual matrix included in the verified double-difference observation residual matrix is called the verified pseudorange double-difference observation residual matrix, and the carrier-phase double-difference observation residual matrix included in the verified double-difference observation residual matrix is called the verified carrier-phase double-difference observation residual matrix.
[0169] In an exemplary embodiment, the manner of obtaining the second correction result based on the updated second state parameters includes extracting a parameter from the updated second state parameters, the type of which is a parameter type that needs to be included in the positioning result of the mobile device, to construct the second correction result, for example, extracting a location type parameter from the updated second state parameters to construct the second correction result.
[0170] In an exemplary embodiment, the updated second state parameters include a position float solution and an integer bias float solution, and the float solution has low accuracy, and in such a case, obtaining the second correction result based on the updated second state parameters includes a step of fixing the integer bias float solution, a step of calculating a position fixed solution using the integer bias fixed solution in response to the fixing of the integer bias float solution being successful, and taking the result including the position float solution as the second correction result, and a step of taking the result including the position float solution as the second correction result in response to the fixing of the integer bias float solution being unsuccessful.
[0171] Exemplarily, the manner of fixing the float solution of the integer bias may be realized by using MLAMBDA (Improved Least Mean Square Ambiguity Decorrelation Adjustment Algorithm). Exemplarily, in the process of fixing the float solution of the integer bias based on MLAMBDA, it may be realized based on the carrier phase double difference parameter value and the carrier phase double difference covariance matrix. The carrier phase double difference parameter value and the carrier phase double difference covariance matrix may be obtained by extracting from the state parameter and the state covariance matrix of the second filter. If the fixing is successful, the position included in the second correction result is the fixed solution obtained by calculating based on the fixing of the integer bias, and has high accuracy.
[0172] In this positioning method, after obtaining the first positioning result, the first observation data is first used to correct the first positioning result, and then the corrected result is corrected again using the double difference observation data, and the target positioning result is further obtained. The process of obtaining the target positioning result comprehensively takes into account the point cloud data, the first observation data, and the double difference observation data, and the information taken into account is abundant, and the accuracy of the target positioning result is high. This positioning method has a low dependency on any one data, and is advantageous in improving the robustness of positioning.
[0173] The embodiment of the present application further provides an implementation process for obtaining a target positioning result based on the first positioning result according to the target data, which is another specific implementation process when the target data includes the first observation data and the double difference observation data. Take the method as an example, which is applied to a mobile device 110. As shown in FIG. 7, the positioning method according to the embodiment of the present application may include the following steps 701 to 703.
[0174] In step 701, the mobile device is positioned using the first observation data to obtain a second positioning result.
[0175] In an exemplary embodiment, the process of positioning a mobile device using the first observation data does not need to take into account point cloud data, i.e., step 701 may be performed independently of the process of positioning a mobile device using point cloud data and obtaining a first positioning result, and the embodiment of the present application does not limit the execution order of step 701 and the process of positioning a mobile device using point cloud data and obtaining a first positioning result.
[0176] For example, the process of positioning a mobile device using the first observation data may be realized by a first filter, and the principle of realizing positioning a mobile device using the first observation data by the first filter is the same as the principle of correcting the first positioning result using the first observation data by the first filter, with the difference being that in the process of correcting the first positioning result using the first observation data by the first filter, the first state parameter of the first filter is determined based on the first positioning result, whereas in the process of positioning a mobile device using the first observation data by the first filter, the first state parameter of the first filter is initialized, and the initialization process does not take into account the first positioning result.
[0177] For example, in the process of realizing the positioning of the mobile device using the first observation data by the first filter, the manner of initializing and obtaining the first state parameter of the first filter includes, but is not limited to, setting the first state parameter of the first filter based on experience, determining the first state parameter of the first filter based on the historical positioning result, decomposing the state parameter of the mobile device based on the first observation data, and determining the first state parameter of the first filter based on the decomposed state parameter. For details of the process of decomposing the state parameter of the mobile device based on the first observation data, please refer to the embodiment shown in FIG. 8, and will not be repeated here.
[0178] In an exemplary embodiment, the process of positioning the mobile device using the first observation data may be realized without the first filter, and illustratively includes decomposing state parameters of the mobile device based on the first observation data, and providing a second positioning result as a result including the state parameters obtained by the decomposition.
[0179] That is, the second positioning result may be obtained based on the state parameters obtained by decomposition, for example, a result including the state parameters obtained by decomposition is used as the second positioning result, or a first state parameter of the first filter is determined based on the state parameters obtained by decomposition, and the second positioning result is obtained by filtering the first filter. The state parameters obtained by decomposition have high accuracy, and obtaining the second positioning result based on the state parameters obtained by decomposition is advantageous in improving the positioning accuracy of the second positioning result.
[0180] Exemplarily, the process of determining the first state parameter of the first filter based on the state parameter obtained by decomposition and obtaining the second positioning result by filtering the first filter includes the steps of: determining the first state parameter of the first filter based on the state parameter obtained by decomposition and obtaining a first state covariance matrix corresponding to the first state parameter; obtaining a first observation residual matrix based on the first observation data and the first state parameter in response to the first observation data satisfying the first screening condition; determining a first measurement update matrix and a first measurement variance matrix corresponding to the first observation residual matrix, determining a first parameter increment based on the first observation residual matrix, the first measurement update matrix, the first measurement variance matrix and the first state covariance matrix, and taking the sum of the first parameter increment and the first state parameter as the updated first state parameter of the first filter; and obtaining the second positioning result based on the updated first state parameter in response to the updated first state parameter satisfying the first criterion condition. The realization principle of this process is the same as step 501 in the embodiment shown in FIG. 5, and will not be repeated here.
[0181] In step 702, the mobile device is positioned using the double difference observation data to obtain a third positioning result.
[0182] In an exemplary embodiment, in the process of using double difference observation data to position a mobile device, point cloud data does not need to be taken into consideration, that is, step 702 may be performed independently of the process of using point cloud data to position a mobile device and obtain a first positioning result, and the embodiment of the present application does not limit the execution order of step 702 and the process of using point cloud data to position a mobile device and obtain a first positioning result. In addition, step 702 may be performed independently of step 701.
[0183] For example, the process of positioning a mobile device using double difference observation data may be realized by a second filter, and the principle of realizing positioning a mobile device using double difference observation data by the second filter is the same as the principle of realizing correcting the first correction result using double difference observation data by the second filter, with the difference being that in the process of realizing correcting the first correction result using double difference observation data by the second filter, the second state parameter of the second filter is determined based on the first correction result, and in the process of realizing positioning a mobile device using double difference observation data by the second filter, the second state parameter of the second filter is initialized, and the initialization process does not take into account the first positioning result, nor does it take into account the first correction result.
[0184] Exemplarily, in the process of realizing positioning of a mobile device using double difference observation data by a second filter, the manner of initializing and obtaining the second state parameter of the second filter includes, but is not limited to, setting the second state parameter of the second filter based on experience, determining the second state parameter of the second filter based on historical positioning results, decomposing the state parameter of the mobile device based on the first observation data, and determining the second state parameter of the second filter based on the decomposed state parameter obtained.
[0185] In step 703, the first positioning result, the second positioning result, and the third positioning result are fused together, and the result obtained by the fusion is set as a target positioning result.
[0186] The first positioning result, the second positioning result, and the third positioning result are all positioning results of the mobile device predicted at the current positioning time, and the first positioning result, the second positioning result, and the third positioning result can be combined to obtain a target positioning result by comprehensively taking into account the point cloud data, the first observation data, and the double difference observation data, which has a low dependency on any of the data of the target positioning result and is advantageous for improving the accuracy and robustness of the target positioning result.
[0187] Exemplarily, to facilitate fusion, the first positioning result, the second positioning result, and the third positioning result all include the same type of parameters, for example, the first positioning result, the second positioning result, and the third positioning result all include a position, or the first positioning result, the second positioning result, and the third positioning result all include a position and a velocity.
[0188] In one possible implementation manner, the implementation process of fusing the first positioning result, the second positioning result, and the third positioning result to obtain the fusion result as the target positioning result includes: obtaining a first weight corresponding to the first positioning result, a second weight corresponding to the second positioning result, and a third weight corresponding to the third positioning result; fusing the first positioning result, the second positioning result, and the third positioning result to obtain the fusion result as the target positioning result of the mobile device according to the first weight, the second weight, and the third weight. The first weight, the second weight, and the third weight are set based on experience or flexibly adjusted according to application scenarios, and the embodiment of the present application is not limited thereto. Exemplarily, for a positioning result obtained by a filter, the weight corresponding to the positioning result may be determined based on a state covariance matrix for obtaining the positioning result.
[0189] In one possible implementation manner, the implementation process of fusing the first positioning result, the second positioning result, and the third positioning result, and obtaining the fused result as the target positioning result of the mobile device may further include a step of fusing any two of the first positioning result, the second positioning result, and the third positioning result to obtain a fused result, and a step of fusing the fused result with an unfused positioning result, and obtaining the fused result as the target positioning result of the mobile device.
[0190] For example, the process of fusing two positioning results may be realized based on weights respectively corresponding to the two positioning results, and the weights respectively corresponding to the two positioning results may be set based on experience or may be flexibly adjusted according to application scenarios, and the embodiments of the present application are not limited thereto.
[0191] In this positioning method, the point cloud data, the first observation data, and the double difference observation data are used to position the mobile device, and three positioning results are obtained, and then the three positioning results are fused to obtain a target positioning result. The process of obtaining the target positioning result comprehensively takes into account the point cloud data, the first observation data, and the double difference observation data, and the information taken into account is abundant, and the accuracy of the target positioning result is high. This positioning method has a low dependency on any one data, and is advantageous for improving the robustness of positioning.
[0192] In an exemplary embodiment, as shown in FIG. 8, the process of decomposing state parameters of a mobile device based on first observation data includes the following steps 801 to 803.
[0193] In step 801, an initial observation residual matrix is obtained based on the first observation data and the initial positioning result, and an initial Jacobian matrix and an initial measurement variance matrix corresponding to the initial observation residual matrix are determined.
[0194] Exemplarily, the initial observation residual matrix is constructed based on the first observation data, the initial positioning result of the mobile device, and the state information of the first satellite, the initial Jacobian matrix is a Jacobian matrix related to the initial positioning result of the initial observation residual matrix, and the initial measurement variance matrix is constructed based on the signal-to-noise ratio of the first observation data and the altitude angle of the first satellite. Exemplarily, the initial Jacobian matrix may be referred to as an initial measurement update matrix.
[0195] The state information of the first satellite includes at least one of the position, clock bias, velocity, and clock drift of the first satellite, and the state information of the first satellite may be obtained by the mobile device based on the first observation data and the navigation ephemeris of the first satellite. The initial positioning result may be set randomly based on experience, and exemplarily, the initial positioning result includes at least one of the initial pseudorange positioning result and the initial Doppler positioning result. The initial pseudorange positioning result includes the initial position and initial clock bias of the mobile device, and the initial Doppler positioning result includes the initial velocity and initial clock drift of the mobile device.
[0196] If the initial positioning result includes an initial pseudorange positioning result, the first observation data includes first pseudorange observation data, the first pseudorange observation data includes pseudorange observation sub-data corresponding to a first satellite, and the state information of the first satellite includes pseudorange state information of the first satellite (i.e., the position and clock bias of the first satellite).If the initial positioning result includes an initial Doppler positioning result, the first observation data includes first Doppler observation data, the first Doppler observation data includes Doppler observation sub-data corresponding to the first satellite, and the state information of the first satellite includes Doppler state information of the first satellite (i.e., the velocity and clock drift of the first satellite).
[0197] Exemplarily, if the initial positioning result includes an initial pseudorange positioning result and an initial Doppler positioning result, the process of resolving the state parameters of the mobile device based on the first observation data is realized by relying on a pseudorange observation equation and a Doppler observation equation.
[0198] Taking the number of first satellites as n as an example, the pseudorange observation equation is as shown in Equation 27. TIFF2024543946000230.tif21170, where TIFF2024543946000231.tif5170 represents pseudorange observation subdata corresponding to a first satellite i (i=1, 2, ..., n) received by a mobile device; TIFF2024543946000232.tif4170 represents the location of a mobile device, TIFF2024543946000233.tif4170 represents the position of the first satellite i, TIFF2024543946000234.tif5170 represents the clock skew (i.e. clock bias) of a mobile device. TIFF2024543946000235.tif4170 represents the clock bias of the first satellite i, c is the speed of light in a vacuum, TIFF2024543946000236.tif5170 represents an error correction number (including corrections due to the ionosphere, troposphere, and Earth rotation, calculated by an empirical model) corresponding to the first satellite i; TIFF2024543946000237.tif6170 is the location of the mobile device TIFF2024543946000238.tif4170 and the position of the first satellite i TIFF2024543946000239.tif4170. In Equation 27, the position of the mobile device TIFF2024543946000240.tif4170 and clock bias of mobile devices The remaining parameters other than TIFF2024543946000241.tif5170 are all known, and can be obtained by estimating the position and clock bias of the mobile device based on the pseudorange observation equation shown in Equation 27.
[0199] Taking the number of first satellites as an example, n, the Doppler observation equation is as shown in Equation 28. TIFF2024543946000242.tif35170 where λ represents the wavelength of the satellite-delivered signal, TIFF2024543946000243.tif5170 represents Doppler observation sub-data corresponding to the first satellite i (i=1, 2, ..., n) received by the mobile device; TIFF2024543946000244.tif4170 represents the velocity of the first satellite i, TIFF2024543946000245.tif4170 represents the speed of a mobile device, TIFF2024543946000246.tif5170 represents clock drift in a mobile device, TIFF2024543946000247.tif5170 represents the clock drift of the first satellite i, and for the meanings of other parameters, refer to the explanation of Equation 27. The speed and clock drift of the mobile device can be estimated and obtained based on the Doppler observation equation shown in Equation 28, and when determining the speed and clock drift of the mobile device, the position of the mobile device and the position of each first satellite need to be provided. Exemplarily, the pseudorange observation equation shown in Equation 27 and the Doppler observation equation shown in Equation 28 may be collectively referred to as a satellite observation equation.
[0200] Exemplarily, a pseudorange observation equation can be used to estimate the location and clock bias of the mobile device, and exemplarily, the location and clock bias of the mobile device can be calculated using the estimated parameters The purpose of estimating the location and clock bias of a mobile device is to estimate the above estimated parameters. The Doppler observation equation can be used to estimate the velocity and clock drift of the mobile device, and illustratively the velocity and clock drift of the mobile device can be calculated using the estimated parameters The purpose of estimating the speed and clock drift of a mobile device is to estimate the above estimated parameters. TIFF2024543946000251.tif4170 is continuously iteratively updated to obtain an estimate of the speed and clock drift of the mobile device.
[0201] For example, the method of decomposing the state parameters of a mobile device provided in the embodiment of the present application may be called a robust weighted least squares method. The robust weighted least squares method is an organic combination of the robust estimation principle and the least squares form by using equivalent weights, and the subject of the measured values generally follows normal distribution, and the least squares method (also called the least squares method) is a mathematical optimization method. It should be noted that the robust weighted least squares method is only an example provided in the embodiment of the present application, and other mathematical optimization methods other than the robust weighted least squares method, such as Newton's method and stochastic gradient descent method, can also be applied, and the embodiment of the present application is not limited thereto.
[0202] In the process of estimating the location and clock bias of a mobile device using the robust weighted least squares method, first, the estimation parameters Set the initial value of TIFF2024543946000252.tif4170, i.e. set the initial position and initial clock bias of the mobile device; In the process of estimating the speed and clock drift of a mobile device using the robust weighted least squares method, we first estimate the estimated parameters Set the initial value of TIFF2024543946000254.tif4170, i.e. set the initial speed and initial clock drift of the mobile device; It is written as TIFF2024543946000255.tif10170.
[0203] If the initial positioning result includes an initial pseudorange positioning result (i.e., an initial position and an initial clock bias of the mobile device), the first observation data includes first pseudorange observation data (i.e., pseudorange observation sub-data corresponding to a first satellite), the state information of the first satellite includes the position and clock bias of the first satellite, and the initial observation residual matrix includes an initial pseudorange observation residual matrix.If the initial positioning result includes an initial Doppler positioning result (i.e., an initial velocity and an initial clock drift of the mobile device), the first observation data includes first Doppler observation data (i.e., Doppler observation sub-data corresponding to a first satellite), the state information of the first satellite includes the velocity and clock drift of the first satellite, and the initial observation residual matrix includes an initial Doppler observation residual matrix.
[0204] An initial pseudorange observation residual matrix is obtained based on an initial position and an initial clock bias of the mobile device, the pseudorange observation sub-data corresponding to the first satellite, and the position and clock bias of the first satellite, and an initial Doppler observation residual matrix is obtained based on an initial velocity and an initial clock drift of the mobile device, the Doppler observation sub-data corresponding to the first satellite, and the velocity and clock drift of the first satellite.
[0205] Exemplarily, the geometric distance between the initial position and the position of the first satellite i, e.g. Get TIFF2024543946000256.tif6170 and calculate the clock bias difference value between the initial clock bias and the clock bias of the first satellite i, e.g. TIFF2024543946000257.tif5170, and based on the geometric distance and the clock bias difference value, calculate a first estimate of the distance between the mobile device and a first satellite i, e.g. TIFF2024543946000258.tif6170, and a pseudorange observation equation between the mobile device and the first satellite can be constructed according to the first estimate and the pseudorange observation sub-data corresponding to the first satellite i. The format of the pseudorange observation equation is as shown in Equation 27 above, and TIFF2024543946000259.tif4170 Replace with TIFF2024543946000260.tif4170, TIFF2024543946000261.tif5170 TIFF2024543946000262.tif5170. Furthermore, both sides of the pseudorange observation equation can be subtracted to obtain an initial pseudorange observation residual matrix, and elements in the initial pseudorange observation residual matrix can be expressed as residual values between the pseudorange observation sub-data corresponding to each first satellite and estimates obtained from the initial position, the position of the first satellite, the initial clock bias, and the clock bias of the first satellite.
[0206] Exemplarily, a velocity difference value between the initial velocity and the velocity of the first satellite i is obtained, and a unit observation value between the mobile device and the first satellite i, e.g. TIFF2024543946000263.tif11170, for example, obtain a clock drift difference value between the initial clock drift and the clock drift of the first satellite i, and based on the product of the velocity difference value and the unit observation value and the clock drift difference value, calculate a second estimate of the time between the mobile device and the first satellite i, for example TIFF2024543946000264.tif11170 is determined. A Doppler observation equation between the mobile device and the first satellite is constructed by the product of the wavelength of the satellite distribution signal and the Doppler observation sub-data corresponding to the first satellite, and the second estimated value. The format of the Doppler observation equation is as shown in Equation 28 above. TIFF2024543946000265.tif4170 Replace with TIFF2024543946000266.tif4170, TIFF2024543946000267.tif5170 Replace with TIFF2024543946000268.tif6170, TIFF2024543946000269.tif4170 TIFF2024543946000270.tif4170. Then, both sides of the Doppler observation equation can be subtracted to obtain the Doppler observation residual matrix.
[0207] After the initial observation residual matrix is constructed, the Jacobian matrix of the initial positioning result of the initial observation residual matrix is taken as the initial Jacobian matrix, and an initial measurement variance matrix is constructed based on the signal-to-noise ratio of the first observation data and the altitude angle of the first satellite.
[0208] For example, if the initial observation residual matrix includes an initial pseudorange observation residual matrix, the initial Jacobian matrix includes an initial pseudorange Jacobian matrix, and the initial measurement variance matrix includes an initial pseudorange measurement variance matrix. The initial pseudorange Jacobian matrix means a Jacobian matrix related to the initial pseudorange positioning result of the initial pseudorange observation residual matrix, and the initial pseudorange measurement variance matrix is constructed based on the signal-to-noise ratio of the pseudorange observation sub-data corresponding to the first satellite and the altitude angle of the first satellite.
[0209] For example, the estimated parameters for the kth iteration (k is an integer) are Assuming that k is 0, the estimated parameters of the kth iteration include the initial position and the initial clock bias, and the satellite observation equation of each iteration is constructed according to the estimated parameters of the current iteration, that is, for the pseudorange observation equation of the kth iteration, the position and clock bias of the mobile device in the above Equation 27 are Position in TIFF2024543946000272.tif4170 TIFF2024543946000273.tif4170 and clock bias TIFF2024543946000274.tif5170. Determine the pseudorange observation equation for the kth iteration as the pseudorange Jacobian for the kth iteration in terms of the partial derivatives of the estimated parameters for the kth iteration. The pseudorange Jacobian for the kth iteration is TIFF2024543946000275.tif5170 and the Jacobian matrix TIFF2024543946000276.tif5170 may be as shown in Equation 29 below. TIFF2024543946000277.tif28170, where TIFF2024543946000278.tif11170 represents the unit observation vector from the mobile device to satellite i (i = 1, 2, ..., n) during the kth iteration, TIFF2024543946000279.tif4170 represents the transpose vector of the unit observation vector from the mobile device to satellite i during the kth iteration. It should be noted that the initial pseudorange Jacobian matrix is the pseudorange Jacobian matrix for k=0, i.e. means TIFF2024543946000280.tif5170.
[0210] Exemplarily, based on the signal-to-noise ratio of the pseudorange observation sub-data corresponding to each of the n first satellites and the altitude angle corresponding to each of the n first satellites, a pseudorange observation error corresponding to each of the n first satellites is determined, and an initial pseudorange measurement variance matrix is constructed with the pseudorange observation errors corresponding to each of the n first satellites as matrix diagonal elements.
[0211] For example, taking the number of pseudorange observation subdata (ie, the number of first satellites) as n, the pseudorange measurement dispersion matrix may be as shown in Equation 30 below. TIFF2024543946000281.tif15170, where TIFF2024543946000282.tif5170 represents the pseudorange measurement variance matrix of the kth iteration, TIFF2024543946000283.tif5170 represents the pseudorange measurement error corresponding to the first satellite i, TIFF2024543946000284.tif5170 may be obtained by calculation based on the following Equation 31. TIFF2024543946000285.tif14170, where TIFF2024543946000286.tif4170 represents the signal-to-noise ratio corresponding to the pseudorange observation sub-data of the first satellite i; TIFF2024543946000287.tif4170 represents the altitude angle of the first satellite i, TIFF2024543946000288.tif5170 represents a pseudorange measurement error parameter, which may be set based on experience or flexibly adjusted according to actual conditions, and the embodiment of the present application is not limited thereto. For example, TIFF2024543946000289.tif5170 to 3 2 may be set to
[0212] Exemplarily, the pseudorange measurement covariance matrix is a matrix with fixed values, and the estimated parameters In the iterative update process of TIFF2024543946000290.tif4170, if the pseudorange observation data used is not changed, the pseudorange measurement dispersion matrix is kept unchanged. That is, the pseudorange measurement dispersion matrix of the kth iteration is the same as the pseudorange measurement dispersion matrix of the 0th iteration (initial pseudorange measurement dispersion matrix), i.e., TIFF2024543946000291.tif5170 is the initial pseudorange measurement dispersion matrix.
[0213] Exemplarily, the process of obtaining an initial pseudorange Jacobian matrix for the initial pseudorange positioning result of the initial pseudorange observation residual matrix is performed when it is determined that the initial pseudorange observation residual matrix satisfies a gross error filtering condition, thereby improving the reliability of the decomposition process of the positioning result. The initial pseudorange observation residual matrix satisfying the gross error filtering condition indicates that the pseudorange observation sub-data corresponding to the initial pseudorange observation residual matrix are all highly reliable. Exemplarily, the process of determining whether the initial pseudorange observation residual matrix satisfies the gross error filtering condition includes the steps of detecting gross errors for the initial pseudorange observation residual matrix based on a quartile, and determining that the initial pseudorange observation residual matrix satisfies the gross error filtering condition if there is no pseudorange observation sub-data that needs to be removed.
[0214] For example, the process of detecting gross errors for an initial pseudorange observation residual matrix based on quartiles can derive many different methods in a specific implementation process. For example, for the same data, the gross error detection conditions are different, and the obtained results may also be different, so the gross error detection methods that bring about different results should be different. The embodiments of the present application use a gross error detection method based on quartiles as an example to describe the gross error detection process, but the embodiments of the present application are not limited thereto.
[0215] The elements in the initial pseudorange observation residual matrix may be sorted in ascending order to obtain a sorted pseudorange observation residual sequence, which may be referred to as a first sequence, and a gross error may be detected for the first sequence based on an upper quartile and a lower quartile of the first sequence, for example, each element in the first sequence may be M 1 / 4 -1.5*(M 3 / 4 -M 1 / 4 ) or M 3 / 4 +1.5*(M 3 / 4 -M 1 / 4) for each element in the first sequence. 1 / 4 -1.5*(M 3 / 4 -M 1 / 4 ) or more, and M 3 / 4 +1.5*(M 3 / 4 -M 1 / 4 ), it is considered that there is no pseudorange observation sub-data that needs to be removed, that is, it is determined that the initial pseudorange observation residual matrix satisfies the gross error filtering condition. 1 / 4 is the lower quartile of the first sequence, and M 3 / 4 is the upper quartile of the first sequence.
[0216] For example, the initial pseudorange observation residual matrix may not satisfy the gross error filtering condition. If the initial pseudorange observation residual matrix does not satisfy the gross error filtering condition, the pseudorange observation sub-data that does not pass the gross error detection is removed from the first initial pseudorange observation data, and the subsequent steps are further performed based on the remaining pseudorange observation data, that is, an initial pseudorange Jacobian matrix and an initial pseudorange measurement covariance matrix are obtained based on the remaining pseudorange observation data.
[0217] For example, if the initial observation residual matrix includes an initial Doppler observation residual matrix, the initial Jacobian matrix includes an initial Doppler Jacobian matrix, and the initial measurement variance matrix includes an initial Doppler measurement variance matrix. The initial Doppler Jacobian matrix is a Jacobian matrix related to the initial Doppler positioning result of the initial Doppler observation residual matrix, and the initial Doppler measurement variance matrix is constructed based on the signal-to-noise ratio of the Doppler observation sub-data corresponding to the first satellite and the altitude angle of the first satellite.
[0218] The principle of obtaining the initial Doppler Jacobian matrix is the same as that of obtaining the pseudorange Jacobian matrix, and the principle of constructing the initial Doppler measurement variance matrix is the same as that of constructing the initial pseudorange measurement variance matrix, and will not be described again here. Exemplarily, the Doppler observation error parameter TIFF2024543946000292.tif5170 may be set based on experience, or may be flexibly adjusted according to actual circumstances, and the embodiments of the present application are not limited thereto. For example, TIFF2024543946000293.tif5170=0.03 2 It is.
[0219] In step 802, a positioning result correction amount is obtained based on the initial observation residual matrix, the initial Jacobian matrix, and the initial measurement variance matrix, and the sum of the positioning result correction amount and the initial positioning result is taken as an intermediate positioning result.
[0220] For example, the initial Jacobian matrix includes an initial pseudorange Jacobian matrix, the initial measurement variance matrix includes an initial pseudorange measurement variance matrix, the initial observation residual matrix includes an initial pseudorange observation residual matrix, the positioning result correction amount includes a pseudorange positioning result correction amount, the initial positioning result includes an initial pseudorange positioning result, and the intermediate positioning result includes an intermediate pseudorange positioning result. In this case, the implementation process of step 802 includes the steps of obtaining a pseudorange positioning result correction amount according to the initial pseudorange Jacobian matrix, the initial pseudorange measurement variance matrix, and the initial pseudorange observation residual matrix, and taking the sum of the pseudorange positioning result correction amount and the initial pseudorange positioning result as the intermediate pseudorange positioning result.
[0221] For example, the pseudorange Jacobian matrix of the k-th iteration is TIFF2024543946000294.tif5170, pseudorange observation residual matrix V for the kth iteration k and the pseudorange measurement variance matrix for the kth iteration Based on TIFF2024543946000295.tif5170, a pseudorange positioning result correction amount of the kth iteration is obtained, and the pseudorange positioning result correction amount of the kth iteration may be as shown in Equation 32 below. TIFF2024543946000296.tif8170, where TIFF2024543946000297.tif5170 represents the pseudorange positioning result correction amount of the kth iteration, TIFF2024543946000298.tif6170 represents the transpose of the pseudorange Jacobian matrix of the kth iteration, and V k denotes the pseudorange observation residual matrix of the kth iteration, and V k is as shown in the following Equation 33. TIFF2024543946000299.tif22170, where TIFF2024543946000300.tif4170, TIFF2024543946000301.tif5170 is the estimate of the mobile device's position and clock bias during the kth iteration, see Equation 27 for the meaning of the other parameters.
[0222] Based on the pseudorange positioning result correction amount of the kth iteration, the pseudorange positioning result estimation parameter TIFF2024543946000302.tif8170 can be updated, and the update process is as shown in Equation 34 below. TIFF2024543946000303.tif5170, where TIFF2024543946000304.tif4170 represents the estimated parameters of the pseudorange positioning result of the k+1th iteration, TIFF2024543946000305.tif4170 represents the estimated parameters of the pseudorange positioning result of the kth iteration (k is an integer equal to or greater than 0); TIFF2024543946000306.tif5170 represents the pseudorange positioning result correction amount of the kth iteration.
[0223] For example, since the current iteration is the 0th iteration, the pseudorange positioning result correction amount is The initial pseudorange positioning result may be represented as TIFF2024543946000307.tif5170. The intermediate pseudorange positioning result may be represented as: The process of making the sum of the pseudorange positioning result correction amount and the initial pseudorange positioning result into the intermediate pseudorange positioning result is as follows: It may be represented as TIFF2024543946000310.tif5170.
[0224] For example, the initial Jacobian matrix includes an initial Doppler Jacobian matrix, the initial measurement variance matrix includes an initial Doppler measurement variance matrix, the initial observation residual matrix includes an initial Doppler observation residual matrix, the positioning result correction amount includes a Doppler positioning result correction amount, the initial positioning result includes an initial Doppler positioning result, and the intermediate positioning result includes an intermediate Doppler positioning result. In this case, the implementation process of step 802 includes the steps of obtaining a Doppler positioning result correction amount according to the initial Doppler Jacobian matrix, the initial Doppler measurement variance matrix, and the initial Doppler observation residual matrix, and summing the Doppler positioning result correction amount and the initial Doppler positioning result as the intermediate Doppler positioning result. The principle of obtaining the intermediate Doppler positioning result is the same as the principle of obtaining the intermediate pseudorange positioning result, and will not be repeated here.
[0225] In step 803, in response to the intermediate positioning result satisfying the first selection condition, a state parameter obtained by decomposition is obtained based on the intermediate positioning result.
[0226] Exemplarily, the intermediate positioning result includes at least one of an intermediate pseudorange positioning result and an intermediate Doppler positioning result. In a situation where the intermediate positioning result includes an intermediate pseudorange positioning result and an intermediate Doppler positioning result, the intermediate positioning result satisfies the first selection condition, which means that the intermediate pseudorange positioning result satisfies the first pseudorange selection condition and the intermediate Doppler positioning result satisfies the first Doppler selection condition. In a situation where the intermediate positioning result includes only an intermediate pseudorange positioning result, the intermediate positioning result satisfies the first selection condition, which means that the intermediate pseudorange positioning result satisfies the first pseudorange selection condition. In a situation where the intermediate positioning result includes only an intermediate Doppler positioning result, the intermediate positioning result satisfies the first selection condition, which means that the intermediate Doppler positioning result satisfies the first Doppler selection condition. In the embodiment of the present application, a case where the intermediate positioning result includes an intermediate pseudorange positioning result and an intermediate Doppler positioning result will be described as an example.
[0227] Exemplarily, the process of determining whether the intermediate pseudorange positioning result satisfies the first pseudorange selection condition includes the steps of: constructing an intermediate pseudorange observation residual matrix based on the intermediate pseudorange positioning result, the first pseudorange observation sub-data corresponding to the first satellite, the position of the first satellite, and a clock bias in response to the pseudorange positioning result correction amount being smaller than the pseudorange correction amount threshold; determining that the intermediate pseudorange observation residual matrix is a pseudorange test statistic by multiplying the transpose of the intermediate pseudorange observation residual matrix, the inverse of the initial pseudorange measurement variance matrix, and the intermediate pseudorange observation residual matrix; and determining that the intermediate pseudorange positioning result satisfies the first pseudorange selection condition in response to the pseudorange test statistic being smaller than the pseudorange statistic threshold.
[0228] The pseudorange correction threshold value is set based on experience or flexibly adjusted according to the application scene, and the embodiment of the present application is not limited thereto. For example, the pseudorange correction threshold value is TIFF2024543946000311.tif8170, and the pseudorange positioning result correction amount is smaller than the pseudorange correction amount threshold. TIFF2024543946000312.tif6170. Exemplarily, the pseudorange positioning result correction amount being smaller than the pseudorange correction amount threshold may be referred to as the pseudorange positioning result correction amount converging. Exemplarily, if the pseudorange positioning result correction amount is equal to or larger than the pseudorange correction amount threshold, the intermediate pseudorange positioning result is taken as the pseudorange positioning initial value of the next iteration, and step 801 and step 802 are repeatedly executed.
[0229] The principle of constructing the intermediate pseudorange observation residual matrix is the same as that of constructing the initial pseudorange observation residual matrix, and will not be repeated here. For example, the process of multiplying the transpose of the intermediate pseudorange observation residual matrix, the inverse of the initial pseudorange measurement variance matrix, and the intermediate pseudorange observation residual matrix as the pseudorange test statistic may be realized according to Equation 35. TIFF2024543946000313.tif6170 where s represents the pseudorange detection statistic, TIFF2024543946000314.tif5170 represents the initial pseudorange measurement covariance matrix, TIFF2024543946000315.tif6170 represents the inverse matrix of the initial pseudorange measurement variance matrix, V represents the intermediate pseudorange observation residual matrix, and the expression format of V is as shown in Equation 36 (V calculated when k in Equation 36 is 0 is the intermediate pseudorange observation residual matrix at this time), and V T represents the transpose of the intermediate pseudorange observation residual matrix. In some embodiments, V may be referred to as a tested pseudorange observation residual matrix. Illustratively, the process of determining whether the pseudorange test statistic is less than the pseudorange statistic threshold is also referred to as a process of performing a chi-square test on the intermediate pseudorange positioning results. TIFF2024543946000316.tif22170, where TIFF2024543946000317.tif4170 represents the position in the intermediate pseudorange positioning result, TIFF2024543946000318.tif5170 shows the clock bias in intermediate pseudorange positioning results, see Equation 27 for the meaning of other parameters.
[0230] If the pseudorange test statistic is smaller than the pseudorange statistic threshold, determine that the intermediate pseudorange positioning result meets the first pseudorange selection condition. The pseudorange statistic threshold can be set based on experience or flexibly adjusted according to application scenarios, and the embodiment of the present application is not limited thereto.
[0231] For example, if the pseudorange test statistic is not smaller than the pseudorange statistic threshold, it is determined that the intermediate pseudorange positioning result does not satisfy the first pseudorange selection condition. In this case, an initial pseudorange residual covariance matrix is constructed based on the initial pseudorange Jacobian matrix and the initial pseudorange measurement variance matrix, an intermediate pseudorange observation residual matrix is tested based on the initial pseudorange residual covariance matrix, a test result corresponding to each element in the intermediate pseudorange observation residual matrix is obtained, and a pseudorange observation sub-data associated with an element whose test result is greater than the test threshold is removed from the first pseudorange observation data, and a new intermediate pseudorange positioning result is obtained based on the remaining pseudorange observation data and the intermediate pseudorange positioning result, and so on until the new intermediate pseudorange positioning result satisfies the first pseudorange selection condition. The test threshold may be set based on experience or flexibly adjusted according to application scenarios.
[0232] Illustratively, the process of constructing the initial pseudorange residual covariance matrix based on the initial pseudorange Jacobian matrix and the initial pseudorange measurement covariance matrix may be implemented according to Equation 37. TIFF2024543946000319.tif8170 where C V represents the initial pseudorange residual covariance matrix, which may also be referred to as the calibrated pseudorange residual covariance matrix, TIFF2024543946000320.tif5170 represents the initial pseudorange measurement covariance matrix, TIFF2024543946000321.tif5170 represents the initial pseudorange Jacobian matrix, TIFF2024543946000322.tif6170 represents the transpose of the initial pseudorange Jacobian matrix.
[0233] For example, a normal distribution test is performed on the pseudorange observation residual matrix of the k+1th iteration (the tested pseudorange observation residual matrix, i.e., the pseudorange observation residual matrix V on which the chi-square test has been performed) using the tested residual covariance matrix, and a test result corresponding to each element in the pseudorange observation residual matrix of the k+1th iteration is obtained.
[0234] Exemplarily, testing the intermediate pseudorange observation residual matrix based on the initial pseudorange residual covariance matrix means performing a normal distribution test on the intermediate pseudorange observation residual matrix based on the initial pseudorange residual covariance matrix.
[0235] Exemplarily, the process of testing the intermediate pseudorange observation residual matrix based on the initial pseudorange residual covariance matrix, obtaining testing results respectively corresponding to each element in the intermediate pseudorange observation residual matrix, and removing pseudorange observation sub-data associated with elements whose testing results are greater than a testing threshold from the first pseudorange observation data may be realized based on Equation 38. TIFF2024543946000323.tif17170, where TIFF2024543946000324.tif4170 represents a residual value corresponding to the first satellite i in the intermediate pseudorange observation residual matrix V, i.e., the i-th element in the intermediate pseudorange observation residual matrix V; TIFF2024543946000325.tif5170 represents the covariance between the first satellite i and the first satellite i in the initial pseudorange residual covariance matrix, TIFF2024543946000326.tif11170 represents the test result corresponding to the i-th element in the intermediate pseudorange observation residual matrix V, and N(α) represents the upper quantile of the normal distribution with confidence level α, which also represents the test threshold.
[0236] Exemplarily, the process of determining whether the intermediate Doppler positioning result satisfies the first Doppler selection condition includes the steps of: constructing an intermediate Doppler observation residual matrix based on the intermediate Doppler positioning result, the first Doppler observation sub-data corresponding to the first satellite, and the speed and clock drift of the first satellite in response to the Doppler positioning result correction amount being smaller than the Doppler correction amount threshold; determining that the intermediate Doppler positioning result satisfies the first Doppler selection condition in response to the Doppler test statistic being smaller than the Doppler statistic threshold. Exemplarily, the principle of determining whether the intermediate Doppler positioning result satisfies the first Doppler selection condition is the same as the principle of determining whether the intermediate pseudorange positioning result satisfies the first pseudorange selection condition, and will not be repeated here.
[0237] When it is determined that the intermediate pseudorange positioning result satisfies the first pseudorange selection condition and the intermediate Doppler positioning result satisfies the first Doppler selection condition, it is determined that the intermediate positioning result satisfies the first selection condition, and then the decomposed state parameters are obtained based on the intermediate positioning result. Exemplarily, the intermediate positioning result includes the intermediate pseudorange positioning result and the intermediate Doppler positioning result, the intermediate pseudorange positioning result includes a position and a clock bias, the intermediate Doppler positioning result includes a velocity and a clock drift, and the position and the clock bias included in the intermediate pseudorange positioning result and the velocity and the clock drift included in the intermediate Doppler positioning result are the decomposed state parameters.
[0238] In an exemplary embodiment, after determining that the intermediate pseudorange positioning result satisfies the first pseudorange selection condition, the pseudorange measurement random error model factor may be self-adaptively estimated further according to Equation 39 below. TIFF2024543946000327.tif10170, where TIFF2024543946000328.tif5170 represents the pseudorange observation random error model factor, V represents the intermediate pseudorange observation residual matrix, and V T represents the transpose of the intermediate pseudorange observation residual matrix, TIFF2024543946000329.tif5170 represents the initial pseudorange measurement covariance matrix, TIFF2024543946000330.tif6170 represents the inverse matrix of the initial pseudorange measurement variance matrix, and n represents the number of pseudorange observation subdata included in the intermediate pseudorange observation residual matrix, i.e., the number of first satellites.
[0239] Exemplary embodiments may further output the intermediate pseudorange positioning results (position and clock bias), the pseudorange observation random error model factors, and information of the pseudorange observation sub-data remaining when obtaining the intermediate pseudorange positioning results, to facilitate subsequent use.
[0240] In an example embodiment, after determining that the intermediate Doppler positioning result satisfies the first Doppler selection condition, the Doppler observation random error model factor may be adaptively estimated. In an example embodiment, the intermediate Doppler positioning result (velocity and clock drift), the Doppler observation random error model factor, and information of the Doppler observation sub-data remaining when obtaining the intermediate Doppler positioning result may be output to facilitate subsequent use.
[0241] Exemplarily, the process of estimating the position and clock bias of a mobile device using the robust weighted least squares method may be as shown in FIG. 9. Set the initial values of the estimation parameters, i.e., the initial position and the initial clock bias, construct a pseudorange measurement residual matrix, and detect gross errors for the pseudorange measurement residual matrix based on quartiles. Calculate the Jacobian matrix for the estimation parameters of the pseudorange measurement residual matrix, and construct a pseudorange measurement variance matrix. Calculate the parameter correction amount, and update the estimation parameters. If the parameter correction amount does not converge, return to the step of constructing the pseudorange measurement residual matrix. If the parameter correction amount converges, calculate the chi-square test statistic. If the chi-square test statistic is greater than the threshold, calculate the tested pseudorange residual covariance matrix, perform a normal distribution test on the tested pseudorange measurement residual matrix based on the tested pseudorange residual covariance matrix, remove the pseudorange measurement sub-data that does not pass the normal distribution test, and return to the step of constructing the pseudorange measurement residual matrix. If the chi-square test statistic is less than or equal to the threshold, the pseudorange observation random error model factor is adaptively estimated, and information from which the mobile device's position, clock bias, pseudorange observation random error model factor, and pseudorange observation sub-data have been removed is output.
[0242] Exemplarily, the process of estimating the speed and clock drift of a mobile device using the robust weighted least squares method may be as shown in FIG. 10. Set the initial values of the estimation parameters, i.e., the initial speed and the initial clock drift, construct a Doppler measurement residual matrix, and detect gross errors for the Doppler measurement residual matrix based on quartiles. Calculate the Jacobian matrix for the estimation parameters of the Doppler measurement residual matrix, and construct a Doppler measurement variance matrix. Calculate the parameter correction amount, and update the estimation parameters. If the parameter correction amount does not converge, return to the step of constructing the Doppler measurement residual matrix. If the parameter correction amount converges, calculate the chi-square test statistic. If the chi-square test statistic is greater than the threshold, calculate a tested Doppler residual covariance matrix, perform a normal distribution test on the tested Doppler measurement residual matrix based on the tested Doppler residual covariance matrix, remove the Doppler observation sub-data that does not pass the normal distribution test, and return to the step of constructing the Doppler measurement residual matrix. If the chi-square test statistic is less than or equal to the threshold, the Doppler observation random error model factor is adaptively estimated, and information from which the mobile device speed, clock drift, Doppler observation random error model factor, and Doppler observation sub-data have been removed is output.
[0243] It should be noted that the embodiments shown in Figures 5 and 7 only describe two exemplary specific implementation processes for obtaining a target positioning result based on the first positioning result according to the target data when the target data includes the first observation data and the double difference observation data, and the embodiments of the present application are not limited thereto. In some embodiments, when the target data includes the first observation data and the double difference observation data, the specific implementation process for obtaining a target positioning result based on the first positioning result according to the target data may further include any of the following implementation processes:
[0244] In realization process 1, the first positioning result is corrected using double difference observation data to obtain a third corrected result, the third corrected result is corrected using the first observation data to obtain a fourth corrected result, and the fourth corrected result is set as the target positioning result.
[0245] The third correction result is a result obtained by correcting the first positioning result using double difference observation data, and the type of parameters included in the third correction result is the same as the type of parameters included in the first positioning result. Exemplarily, the process of correcting the first positioning result using double difference observation data to obtain the third correction result may be realized by using a second filter, and the realization principle is the same as the realization principle of step 502 in the embodiment shown in FIG. 5.
[0246] The fourth correction result is obtained by correcting the third correction result using the first observation data, and is more reliable than the third correction result. After obtaining the fourth correction result, the fourth correction result is set as the target positioning result of the mobile device, which is advantageous to ensure the reliability of the target positioning result and improve the positioning accuracy and positioning robustness of the target positioning result. Exemplarily, the process of correcting the third correction result using the first observation data to obtain the fourth correction result may be realized by using a first filter, and the realization principle is the same as the realization principle of step 501 in the embodiment shown in FIG. 5.
[0247] In the second implementation, the first observation data is used to correct the first positioning result to obtain a first corrected result, the double difference observation data is used to position the mobile device to obtain a third positioning result, the first corrected result and the third positioning result are fused, and the fused result is used as the target positioning result.
[0248] The realization process of correcting the first positioning result using the first observation data to obtain the first correction result, and the realization process of positioning the mobile device using the double difference observation data to obtain the third positioning result are referred to the above related description and will not be described repeatedly here. After obtaining the first correction result and the third positioning result, the first correction result and the third positioning result are fused, and the fusion result is the target positioning result. Exemplarily, the realization process of fusing the first correction result and the third positioning result includes the steps of obtaining weights respectively corresponding to the first correction result and the third positioning result, and fusing the first correction result and the third positioning result according to the weights respectively corresponding to the first correction result and the third positioning result.
[0249] In the realization process 3, the first positioning result is corrected using the double difference observation data to obtain a third corrected result, the mobile device is positioned using the first observation data to obtain a second positioning result, the third corrected result and the second positioning result are fused, and the fused result is the target positioning result.
[0250] The realization process of correcting the first positioning result by using the double difference observation data to obtain the third correction result, and the realization process of positioning the mobile device by using the first observation data to obtain the second positioning result are referred to the above related description and will not be described repeatedly here. After obtaining the third correction result and the second positioning result, the third correction result and the second positioning result are fused, and the fusion result is the target positioning result. Exemplarily, the realization process of fusing the third correction result and the second positioning result includes the steps of obtaining weights respectively corresponding to the third correction result and the second positioning result, and fusing the third correction result and the second positioning result according to the weights respectively corresponding to the third correction result and the second positioning result.
[0251] The realization process 4 includes a step of correcting the first positioning result using the first observation data to obtain a first correction result, correcting the first positioning result using the double difference observation data to obtain a third correction result, and a step of fusing the third correction result and the first correction result and setting the result obtained by the fusion as the target positioning result.
[0252] The realization process of correcting the first positioning result using the first observation data to obtain the first correction result, and the realization process of correcting the first positioning result using the double difference observation data to obtain the third correction result, refer to the above related description and will not be described repeatedly here. After obtaining the first correction result and the third correction result, the first correction result and the third correction result are fused, and the fusion result is the target positioning result. Exemplarily, the realization process of fusing the first correction result and the third correction result includes the steps of obtaining weights respectively corresponding to the first correction result and the third correction result, and fusing the first correction result and the third correction result according to the weights respectively corresponding to the first correction result and the third correction result.
[0253] In the realization process 5, the steps include positioning a mobile device using first observation data to obtain a second positioning result, correcting the second positioning result using double difference observation data to obtain a fifth corrected result, and fusing the fifth corrected result with the first positioning result, and the fusing result is the target positioning result.
[0254] For the implementation process of using the first observation data to position the mobile device and obtain the second positioning result, please refer to the above related description and will not be described again here. The implementation principle of using double difference observation data to correct the second positioning result is the same as the implementation principle of using double difference observation data to correct the first correction result, and the result obtained by correcting the second positioning result using the double difference observation data is the fifth correction result.
[0255] Exemplarily, the realization process of fusing the fifth correction result and the first positioning result includes the steps of obtaining weights corresponding to the fifth correction result and the first positioning result, respectively, and fusing the fifth correction result and the first positioning result based on the weights corresponding to the fifth correction result and the first positioning result, respectively.
[0256] The realization process 6 includes the steps of positioning a mobile device using double-difference observation data to obtain a third positioning result, correcting the third positioning result using the first observation data to obtain a sixth correction result, and fusing the sixth correction result with the first positioning result and setting the fused result as the target positioning result.
[0257] For the implementation process of using the double difference observation data to position the mobile device and obtain the third positioning result, please refer to the above related description and will not be described again here. The implementation principle of using the first observation data to correct the third positioning result is the same as the implementation principle of using the first observation data to correct the first positioning result, and the result obtained by correcting the third positioning result using the first observation data is the sixth corrected result.
[0258] Exemplarily, the realization process of fusing the sixth correction result and the first positioning result includes a step of obtaining weights corresponding to the sixth correction result and the first positioning result, respectively, and fusing the sixth correction result and the first positioning result based on the weights corresponding to the sixth correction result and the first positioning result, respectively.
[0259] The realization process 7 includes the steps of positioning a mobile device using first observation data to obtain a second positioning result, fusing the first positioning result and the second positioning result to obtain a first fusion result, and correcting the first fusion result using double-difference observation data and setting the corrected result as a target positioning result.
[0260] For the implementation process of positioning the mobile device using the first observation data and obtaining the second positioning result, please refer to the above related description and will not be described repeatedly here. Exemplarily, the implementation process of fusing the first positioning result and the second positioning result to obtain the first fusion result includes the steps of obtaining weights respectively corresponding to the first positioning result and the second positioning result, and fusing the first positioning result and the second positioning result based on the weights respectively corresponding to the first positioning result and the second positioning result to obtain the first fusion result.
[0261] The implementation principle of correcting the first fusion result using double difference observation data is the same as the implementation principle of correcting the first correction result using double difference observation data, and the result obtained by correcting the first fusion result using double difference observation data is the target positioning result of the mobile device.
[0262] The realization process 8 includes the steps of positioning a mobile device using double difference observation data to obtain a third positioning result, fusing the first positioning result and the third positioning result to obtain a second fusion result, and correcting the second fusion result using the first observation data and setting the corrected result as a target positioning result.
[0263] For the implementation process of using double difference observation data to position a mobile device and obtain a third positioning result, please refer to the above related description and will not be described repeatedly here. Exemplarily, the implementation process of fusing the first positioning result and the third positioning result to obtain a second fusion result includes: obtaining weights respectively corresponding to the first positioning result and the third positioning result, and fusing the first positioning result and the third positioning result according to the weights respectively corresponding to the first positioning result and the third positioning result to obtain a second fusion result.
[0264] The implementation principle of correcting the second fusion result using the first observation data is the same as the implementation principle of correcting the first positioning result using the first observation data, and the result obtained by correcting the second fusion result using the first observation data is the target positioning result of the mobile device.
[0265] In an exemplary embodiment, the target data required to obtain a target positioning result based on the first positioning result may include only the first observation data, and in such a case, a specific realization process of obtaining a target positioning result based on the first positioning result based on the target data may include the following realization process 1 and realization process 2.
[0266] In the realization process 1, the first positioning result is corrected using the first observation data to obtain a first corrected result, and the first corrected result is set as the target positioning result.
[0267] The implementation process of correcting the first positioning result using the first observation data to obtain the first corrected result is referred to the above related description, and will not be described again here. After obtaining the first corrected result, the first corrected result is directly set as the target positioning result of the mobile device.
[0268] In the realization process 2, the mobile device is positioned using the first observation data, a second positioning result is obtained, the first positioning result and the second positioning result are fused, and the fused result is regarded as the target positioning result.
[0269] For the implementation process of positioning the mobile device using the first observation data and obtaining the second positioning result, please refer to the above related description, and the description will not be repeated here.
[0270] Exemplarily, the realization process of fusing the first positioning result and the second positioning result includes: obtaining weights respectively corresponding to the first positioning result and the second positioning result, and fusing the first positioning result and the second positioning result according to the weights respectively corresponding to the first positioning result and the second positioning result. After fusing, the obtained fusion result is a target positioning result of the mobile device.
[0271] In an exemplary embodiment, the target data required to obtain the target positioning result based on the first positioning result may include only double difference observation data. In such a case, the specific implementation process of obtaining the target positioning result based on the first positioning result based on the target data includes the following implementation process A and implementation process B.
[0272] In the realization process A, the first positioning result is corrected using double difference observation data to obtain a third corrected result, and the third corrected result is set as the target positioning result.
[0273] The implementation process of correcting the first positioning result by using the double difference observation data to obtain the third correction result is referred to the above related description, and will not be described again here. After obtaining the third correction result, the third correction result is directly taken as the target positioning result of the mobile device.
[0274] The realization process B includes a step of positioning a mobile device using double difference observation data to obtain a third positioning result, fusing the first positioning result and the third positioning result, and setting the fused result as a target positioning result.
[0275] For the implementation process of using double difference observation data to position the mobile device and obtain the third positioning result, please refer to the above related description, and the description will not be repeated here.
[0276] Exemplarily, the realization process of fusing the first positioning result and the third positioning result includes: obtaining weights respectively corresponding to the first positioning result and the third positioning result, and fusing the first positioning result and the third positioning result according to the weights respectively corresponding to the first positioning result and the third positioning result. After fusing, the obtained fusion result is a target positioning result of the mobile device.
[0277] Exemplarily, the frame of the positioning method may be as shown in FIG. 11. The mobile device obtains the observation data of the mobile device, the navigation ephemeris, and the observation data of the reference station from the CORS system based on the NTRIP protocol. A communication connection is established between the CORS system and the satellite. Based on the observation data of the mobile device and the navigation ephemeris, a second positioning result of the mobile device is obtained using a first filter, and based on the observation data of the mobile device, the observation data of the reference station, and the navigation ephemeris, a third positioning result of the mobile device is obtained using an RTK algorithm and a second filter. The point cloud data scanned by the laser radar attached to the mobile device is obtained, and the point cloud data of the adjacent frames is matched based on the NDT algorithm to obtain a position change amount, and the first positioning result of the mobile device is obtained based on a constraint equation corresponding to the position change amount. The first positioning result, the second positioning result, and the third positioning result are fused to obtain a target positioning result, and the target positioning result is output. By continuously outputting the latest target positioning result, a moving trajectory of the mobile device can be generated.
[0278] In the process of obtaining the positioning result by the filter, the present invention relates to detection and repair of filter failures, detection and repair of clock bias jumps and clock drift jumps, verification and repair of the filter model, and detection and removal of gross errors. In the process of obtaining the third positioning result, the present invention relates to a process of fixing the integer bias based on MLAMBDA, and if the fixing is successful, a fixed solution of the position is obtained, and if the fixing is not successful, a float solution of the position is obtained.
[0279] Illustratively, the detailed process of the positioning method may be as shown in Fig. 12. According to the step in the dotted frame 1201, a process of using a first filter to obtain a second positioning result of a mobile device based on observation data and navigation ephemeris of the mobile device is realized, and for the step in the dotted frame 1201, refer to step 501 in Fig. 5 and the embodiment shown in Fig. 8, and the difference from step 501 in Fig. 5 is that in the dotted frame 1201, the first filter is initialized (i.e., the first state parameter of the first filter is determined) using the state parameter of the mobile device obtained by decomposition based on the robust weighted least squares method and the first observation data, rather than determining the first state parameter of the first filter based on the first positioning result.
[0280] According to the steps in the dotted frame 1202, a process is realized to obtain a third positioning result of a mobile device using an RTK algorithm and a second filter based on the observation data of the mobile device, the observation data of the reference station and the navigation ephemeris. For the steps in the dotted frame 1202, refer to step 502 in FIG. 5. The difference from step 502 in FIG. 5 is that in the dotted frame 1202, the second state parameters of the second filter are not determined based on the first correction result, but the second filter is initialized using the state parameters of the mobile device obtained by decomposition based on the robust weighted least squares method and the first observation data (i.e., the second state parameters of the second filter are determined).
[0281] The second positioning result and the third positioning result are fused to obtain a fusion result. According to the steps in the dotted box 1203, a process of obtaining a first positioning result of the mobile device based on the point cloud data is realized, and for the steps in the dotted box 1203, refer to step 301 in the embodiment shown in Figure 3. The fusion result and the first positioning result are fused to obtain a target positioning result, and the current target positioning result of the mobile device is output.
[0282] For example, the positioning method according to the embodiment of the present application may be applied to a mobile phone terminal positioning navigation application scene (e.g., electronic map application), and may also be applied to a lane-level navigation application scene, and may realize sub-meter level or lane-level positioning and assist lane-level positioning navigation. Here, sub-meter level positioning means that the accuracy of the positioning result can reach meters, centimeters, and even millimeters.
[0283] For example, the embodiments of the present application provide a positioning method that constructs a position change constraint equation based on laser radar point cloud matching information, and combines RTK and laser radar based on a Kalman filter, thereby reducing the dependency on satellite signals, solving the problem of low positioning accuracy in complex scenes such as severe satellite signal obstruction and obvious multipath effect, solving the problem of discontinuous vehicle positioning and position jumps in complex scenes such as rows of buildings and urban canyons, solving the problem of inaccurate vehicle positioning and position drift in complex urban scenes such as weak satellite signal scenes, improving the availability and reliability of satellite positioning in scenes with weak satellite signals, and assisting mobile phones and vehicle-mounted devices in lane-level positioning navigation in road scenes such as highways and viaducts (as shown in FIG. 13).
[0284] For example, the application scene of the positioning method according to the embodiment of the present application may be as shown in Figure 14. The target positioning result of the mobile device is obtained by comprehensively taking into account the data related to satellite observation (for example, the observation data of the mobile device itself, the double difference observation data between the observation data of the mobile device and the observation data of the reference station) and the point cloud data. Based on this positioning method, it is possible to provide the basis for lane-level navigation, recognize drift, lane change, and main roads and secondary roads, and realize functions such as high-precision positioning, stable positioning, and reliable positioning.
[0285] As shown in FIG. 15 , an embodiment of the present application provides a positioning device, the device comprising: A first acquisition unit 1401 for acquiring point cloud data scanned by a radar attached to a mobile device; a positioning unit 1402 for positioning a mobile device using point cloud data to obtain a first positioning result; a second acquisition unit 1403 for acquiring first observation data received by a satellite positioning device attached to the mobile device; and a third acquiring unit 1404 for acquiring a target positioning result of the mobile device based on the first observation data and the first positioning result.
[0286] In one possible implementation manner, the third acquisition unit 1404 acquires target data based on the first observation data, including at least one of the first observation data and double difference observation data calculated and acquired based on the first observation data and reference observation data received by a satellite positioning equipment installed on a reference station, and acquires a target positioning result based on the first positioning result based on the target data.
[0287] In one possible implementation manner, the target data includes first observation data and double difference observation data, and the third acquisition unit 1404 corrects the first positioning result using the first observation data to obtain a first correction result, and corrects the first correction result using the double difference observation data to obtain a second correction result, and the second correction result is the target positioning result.
[0288] In one possible implementation manner, the third acquisition unit 1404 acquires first state parameters of the first filter based on the first positioning result, acquires a first state covariance matrix corresponding to the first state parameters, acquires a first observation residual matrix based on the first observation data and the first state parameters in response to the first observation data satisfying the first screening condition, determines a first measurement update matrix and a first measurement variance matrix corresponding to the first observation residual matrix, determines a first parameter increment based on the first observation residual matrix, the first measurement update matrix, the first measurement variance matrix and the first state covariance matrix, determines a sum of the first parameter increment and the first state parameters as the updated first state parameters of the first filter, and acquires a first correction result based on the updated first state parameters in response to the updated first state parameters satisfying the first criterion condition.
[0289] In one possible implementation, the apparatus further includes a determining unit; The determination unit determines a covariance increment based on the first measurement update matrix, the first measurement variance matrix, and the first state covariance matrix, determines a product of the covariance increment and the first state covariance matrix as an updated first state covariance matrix, detects a correction amount for the first parameter increment based on the updated first state covariance matrix, and in response to passing the detection of the correction amount, tests a first observation residual matrix based on the updated first state covariance matrix, the first measurement variance matrix, and a first residual covariance matrix constructed based on the first measurement update matrix to obtain a test result respectively corresponding to each element in the first observation residual matrix, and in response to the test results respectively corresponding to each element in the first observation residual matrix all satisfying the test condition, determines that the updated first state parameter satisfies a first reference condition.
[0290] In one possible implementation manner, the determination unit further determines a model validation parameter value corresponding to the first filter based on the first observation data, the first state parameters, and the first state covariance matrix, obtains a test result of the observation sub-data in the first observation data in response to the model validation parameter value being smaller than a first threshold, and determines that the first observation data satisfies the first sorting condition in response to the test results of the observation sub-data in the first observation data all satisfying the retention condition.
[0291] In one possible implementation manner, the determination unit further performs a normalization process on the first observation residual matrix based on the first measurement update matrix, the first measurement variance matrix, and the first state covariance matrix to obtain a normalized residual matrix, and tests the normalized residual matrix, each element of which is associated with one observation sub-data in the first observation data, based on a second residual covariance matrix constructed based on the first measurement update matrix, the first measurement variance matrix, and the first state covariance matrix to obtain a test result corresponding to each element in the normalized residual matrix, and the test result corresponding to each element in the normalized residual matrix is the test result of the corresponding observation sub-data in the first observation data.
[0292] In one possible implementation manner, the third acquisition unit 1404 determines a second state parameter of the second filter based on the first correction result, acquires a second state covariance matrix corresponding to the second state parameter, acquires a double-difference observation residual matrix based on the double-difference observation data and the second state parameter in response to the double-difference observation data satisfying the second screening condition, determines a double-difference measurement update matrix and a double-difference measurement variance matrix corresponding to the double-difference observation residual matrix, determines a second parameter increment based on the double-difference observation residual matrix, the double-difference measurement update matrix, the double-difference measurement variance matrix and the second state covariance matrix, and determines a sum of the second parameter increment and the second state parameter as the updated second state parameter of the second filter, and acquires a second correction result based on the updated second state parameter in response to the updated second state parameter satisfying the second criterion condition.
[0293] In one possible implementation manner, the third acquisition unit 1404 acquires double-differenced estimation data according to the second state parameters, and constructs a double-differenced observation residual matrix according to the double-differenced observation data and the double-differenced estimation data.
[0294] In one possible implementation manner, the updated second state parameters include a position float solution and an integer bias float solution, and the third acquisition unit 1404 fixes the integer bias float solution, and in response to the fixing of the integer bias float solution being successful, calculates a position fixed solution using the integer bias fixed solution, and takes the result including the position fixed solution as the second corrected result, and in response to the fixing of the integer bias float solution being unsuccessful, takes the result including the position float solution as the second corrected result.
[0295] In one possible implementation manner, the target data includes first observation data and double difference observation data, and the third acquisition unit 1404 uses the first observation data to position the mobile device to obtain a second positioning result, uses the double difference observation data to position the mobile device to obtain a third positioning result, fuses the first positioning result, the second positioning result and the third positioning result, and the fused result is the target positioning result.
[0296] In one possible implementation manner, the third acquiring unit 1404 decomposes state parameters of the mobile device according to the first observation data, and acquires a second positioning result according to the decomposed state parameters acquired.
[0297] In one possible implementation manner, the third acquisition unit 1404 acquires an initial observation residual matrix based on the first observation data and the initial positioning result, determines an initial Jacobian matrix and an initial measurement variance matrix corresponding to the initial observation residual matrix, acquires a positioning result correction amount based on the initial observation residual matrix, the initial Jacobian matrix and the initial measurement variance matrix, obtains a sum of the positioning result correction amount and the initial positioning result as an intermediate positioning result, and acquires state parameters obtained by decomposition based on the intermediate positioning result in response to the intermediate positioning result satisfying the first selection condition.
[0298] In one possible implementation manner, the third acquisition unit 1404 acquires a first weight corresponding to the first positioning result, a second weight corresponding to the second positioning result, and a third weight corresponding to the third positioning result, and fuses the first positioning result, the second positioning result, and the third positioning result based on the first weight, the second weight, and the third weight, and obtains the fused result as the target positioning result.
[0299] In one possible implementation manner, the third acquisition unit 1404 fuses any two of the first positioning result, the second positioning result, and the third positioning result to obtain a fusion result, fuses the fusion result with the unfused positioning result, and the fusion result obtained is the target positioning result.
[0300] In one possible implementation manner, the positioning unit 1402 matches the point cloud data with historical point cloud data located in a frame prior to the point cloud data to obtain point cloud matching information, determines a position change amount based on the point cloud matching information, corrects the historical position of the mobile device based on the position change amount to obtain a first position, and obtains the positioning result including the first position as the first positioning result.
[0301] In one possible implementation manner, the target data includes first observation data and double difference observation data, and the third acquisition unit 1404 corrects the first positioning result using the double difference observation data to obtain a third correction result, and corrects the third correction result using the first observation data to obtain a fourth correction result, and the fourth correction result is the target positioning result.
[0302] In one possible implementation manner, the target data includes first observation data and double difference observation data, and the third acquisition unit 1404 corrects the first positioning result using the first observation data to obtain a first correction result, positions the mobile device using the double difference observation data to obtain a third positioning result, fuses the first correction result and the third positioning result, and the fused result is the target positioning result.
[0303] In one possible implementation manner, the target data includes first observation data and double difference observation data, and the third acquisition unit 1404 corrects the first positioning result using the double difference observation data to obtain a third corrected result, positions the mobile device using the first observation data to obtain a second positioning result, fuses the third corrected result and the second positioning result, and the fused result is the target positioning result.
[0304] In one possible implementation manner, the target data includes first observation data and double difference observation data, and the third acquisition unit 1404 corrects the first positioning result using the first observation data to obtain a first correction result, corrects the first positioning result using the double difference observation data to obtain a third correction result, fuses the third correction result and the first correction result, and the fused result is the target positioning result.
[0305] In one possible implementation manner, the target data includes first observation data and double difference observation data, and the third acquisition unit 1404 uses the first observation data to position the mobile device to obtain a second positioning result, corrects the second positioning result using the double difference observation data to obtain a fifth corrected result, fuses the fifth corrected result and the first positioning result, and the fused result is the target positioning result.
[0306] In one possible implementation manner, the target data includes first observation data and double difference observation data, and the third acquisition unit 1404 uses the double difference observation data to position the mobile device to obtain a third positioning result, corrects the third positioning result using the first observation data to obtain a sixth correction result, fuses the sixth correction result and the first positioning result, and the fused result is the target positioning result.
[0307] In one possible implementation manner, the target data includes first observation data and double difference observation data, and the third acquisition unit 1404 uses the first observation data to position the mobile device to obtain a second positioning result, fuses the first positioning result and the second positioning result to obtain a first fusion result, and corrects the first fusion result using the double difference observation data, and the corrected obtained result is the target positioning result.
[0308] In one possible implementation manner, the target data includes first observation data and double difference observation data, and the third acquisition unit 1404 uses the double difference observation data to position the mobile device to obtain a third positioning result, fuses the first positioning result and the third positioning result to obtain a second fusion result, and corrects the second fusion result using the first observation data, and the corrected obtained result is the target positioning result.
[0309] In one possible implementation manner, the target data includes first observation data, and the third acquisition unit 1404 corrects the first positioning result using the first observation data to obtain a first corrected result, and the first corrected result serves as the target positioning result; or uses the first observation data to position the mobile device to obtain a second positioning result, and fuses the first positioning result and the second positioning result, and serves as the target positioning result.
[0310] In one possible implementation manner, the target data includes double difference observation data, and the third acquisition unit 1404 corrects the first positioning result using the double difference observation data to obtain a third corrected result, and the third corrected result serves as the target positioning result, or uses the double difference observation data to position the mobile device to obtain a third positioning result, and fuses the first positioning result and the third positioning result, and serves as the target positioning result obtained by fusing.
[0311] In the positioning device of the embodiment of the present application, the final target positioning result of the mobile device is obtained by comprehensively taking into consideration the point cloud data scanned by the radar attached to the mobile device and the first observation data received by the satellite positioning device, and the point cloud data and the first observation data can complement each other. Such a positioning method can reduce the dependency on any one of the point cloud data and the first observation data. Even if the quality of the point cloud data or the first observation data is poor, a more accurate target positioning result can be obtained by additionally taking into consideration the other data, which is highly robust and advantageous in meeting actual positioning needs.
[0312] It should be noted that, when the device according to the above embodiment realizes its functions, it is described by taking an example of the division of each functional unit, but in actual application, the above functions can be allocated to different functional units as necessary, that is, the internal configuration of the device can be divided into different functional units to realize some or all of the functions described above. Furthermore, the device according to the above embodiment belongs to the same concept as the method embodiment, and the specific realization process details thereof are referred to the method embodiment, and will not be described again here.
[0313] 16 is a schematic diagram of a mobile device according to an embodiment of the present application. The mobile device may be a mobile phone, a computer, a smart voice dialogue device, a smart home appliance, a vehicle-mounted terminal, a helicopter, etc. The mobile device may also be called a user device, a mobile terminal, a laptop terminal, a desktop terminal, etc.
[0314] Typically, the mobile device includes a processor 1501 and a memory 1502 .
[0315] The processor 1501 may include one or more processing cores, such as a 4-core processor, an 8-core processor, etc. The processor 1501 may be implemented using at least one hardware form of DSP (Digital Signal Processing), FPGA (Field-Programmable Gate Array), and PLA (Programmable Logic Array). The processor 1501 may include a main processor and a coprocessor, where the main processor is a processor that processes data in an awake state and is also called a CPU (Central Processing Unit), and the coprocessor is a low-power processor that processes data in a standby state. In some embodiments, the processor 1501 may be integrated with a GPU (Graphics Processing Unit), which performs rendering and drawing for content that needs to be displayed on a display screen. In some embodiments, the processor 1501 may further include an AI (Artificial Intelligence) processor, which processes computational operations related to machine learning.
[0316] The memory 1502 may include one or more computer-readable storage media, which may be non-transitory. The memory 1502 may further include high-speed random access memory, and non-volatile memory, such as one or more magnetic disk storage devices, flash memory storage devices, etc. In some embodiments, the non-transitory computer-readable storage media in the memory 1502 stores at least one instruction that is executed by the processor 1501 to cause the mobile device to implement a positioning method according to a method embodiment of the present application.
[0317] In some embodiments, the mobile device optionally further includes a radar 1515 and a satellite positioning device 1516. The radar 1515 scans the point cloud data around the mobile device, and the satellite positioning device 1516 receives the first observation data corresponding to the mobile device, so that the mobile device can position the mobile device by jointly taking into account the point cloud data and the first observation data, thereby improving the accuracy and robustness of the positioning.
[0318] As will be appreciated by those skilled in the art, the structure shown in FIG. 16 is not intended to be limiting of the mobile device, which may include more or fewer components than shown, may combine some components, and may be arranged using different assemblies.
[0319] 17 is a schematic diagram of a server according to an embodiment of the present application. The server may vary greatly depending on the layout or performance, and may include one or more processors (Central Processing Units, CPU) 1701 and one or more memories 1702, and at least one computer program is stored in the one or more memories 1702, and the at least one computer program is loaded and executed by the one or more processors 1701 to cause the server to realize the positioning method according to the embodiment of the above method. Of course, the server may further include components such as a wired or wireless network interface, a keyboard, and an input / output interface to facilitate input / output, and the server may further include other components to realize device functions, which will not be described again here.
[0320] In an exemplary embodiment, a computing device is further provided, the computing device including a processor and a memory having stored therein at least one computer program that, when loaded and executed by the one or more processors, causes the computing device to implement any of the positioning methods described above.
[0321] In an exemplary embodiment, a non-volatile computer readable storage medium is further provided, which stores at least one computer program that, when loaded and executed by a processor of a computing device, causes the computer to implement any of the above positioning methods.
[0322] In one possible implementation, the non-volatile computer-readable storage medium may be a Read-Only Memory (ROM), a Random Access Memory (RAM), a Compact Disc Read-Only Memory (CD-ROM), a magnetic tape, a floppy disk, an optical data storage device, and the like.
[0323] In an exemplary embodiment, a computer program product is provided, which includes computer programs or computer instructions which, when loaded and executed by a processor, cause a computer to implement any of the positioning methods described above.
[0324] In an exemplary embodiment, a computer program is provided, the computer program comprising computer instructions which, when loaded and executed by a processor, cause a computer to implement any of the positioning methods described above.
[0325] It should be explained that the information (including but not limited to user device information, user personal information, etc.), data (including but not limited to data for analysis, stored data, displayed data, etc.) and signals related to the present application are all approved by the user or fully approved by each party, and the collection, use and processing of related data must comply with the relevant laws, regulations and standards of the relevant countries and regions. For example, the point cloud data, observation data, positioning results, etc. related to the present application are obtained when fully approved.
[0326] It should be explained that the terms "first", "second", etc., used herein are intended to distinguish between similar objects and not necessarily to describe a particular order or priority. It should be understood that the data used in this manner may be interchanged as appropriate, such that the embodiments of the present application described herein may be practiced in other orders than those shown or described herein. The embodiments described in the following illustrative examples do not represent all embodiments consistent with the present application. On the contrary, they are merely examples of apparatus and methods consistent with certain aspects of the present application, as detailed in the appended claims.
[0327] It should be understood that "plurality" as referred to herein means two or more than two. "And / or" describes a relationship between related objects and indicates that three types of relationships may exist, for example, A and / or B can represent three situations: A exists alone, A and B exist simultaneously, and B exists alone. The character " / " generally indicates that the related objects before and after are in an "or" relationship.
[0328] The above description is only an illustrative embodiment of the present application, and is not used to limit the present application, and any amendments, equivalent replacements, improvements, etc. made within the principle of the present application should be included within the protection scope of the present application.
Claims
1. 1. A method of positioning implemented by a computing device, comprising: acquiring point cloud data scanned by a radar attached to a mobile device, and positioning the mobile device using the point cloud data to obtain a first positioning result; acquiring first observation data received by a satellite positioning device attached to the mobile device; obtaining a target positioning result for the mobile device based on the first observation data and the first positioning result.
2. The step of acquiring a target positioning result of the mobile device based on the first observation data and the first positioning result includes: Based on the first observation data, double difference observation data obtained by calculation based on the first observation data and reference observation data received by a satellite positioning device installed at a reference station; acquiring target data including at least one of the following: The method of claim 1 , further comprising: obtaining the target positioning result based on the first positioning result based on the target data.
3. the target data includes the first observation data and the double difference observation data; The step of acquiring the target positioning result based on the first positioning result based on the target data includes: correcting the first positioning result using the first observation data to obtain a first corrected result; The method of claim 2 , further comprising: correcting the first correction result using the double difference observation data to obtain a second correction result; and setting the second correction result as the target positioning result.
4. The step of correcting the first positioning result by using the first observation data to obtain a first correction result includes: obtaining first state parameters of a first filter based on the first positioning result, and obtaining a first state covariance matrix corresponding to the first state parameters; obtaining a first observation residual matrix based on the first observation data and the first state parameters in response to the first observation data satisfying a first screening condition; determining a first measurement update matrix and a first measurement covariance matrix corresponding to the first observation residual matrix; determining a first parameter increment based on the first observation residual matrix, the first measurement update matrix, the first measurement variance matrix, and the first state covariance matrix, and setting a sum of the first parameter increment and the first state parameter as an updated first state parameter of the first filter; and obtaining the first correction result based on the updated first state parameter in response to the updated first state parameter satisfying a first reference condition.
5. determining a covariance increment based on the first measurement update matrix, the first measurement variance matrix, and the first state covariance matrix, and defining the product of the covariance increment and the first state covariance matrix as an updated first state covariance matrix; detecting a correction amount for the first parameter increment based on the updated first state covariance matrix; in response to passing the detection of the correction amount, validating the first observation residual matrix based on the updated first state covariance matrix, the first measurement variance matrix, and a first residual covariance matrix constructed based on the first measurement update matrix, to obtain a validation result corresponding to each element in the first observation residual matrix; and determining that the updated first state parameters satisfy the first criterion condition in response to all of the test results corresponding to each element in the first observation residual matrix satisfying a test condition.
6. determining model validation parameter values corresponding to the first filter based on the first observation data, the first state parameters, and the first state covariance matrix; The method of claim 4, further comprising: obtaining a test result of observation sub-data in the first observation data in response to the model validation parameter value being smaller than a first threshold; and determining that the first observation data satisfies the first selection condition in response to all of the test results of the observation sub-data in the first observation data satisfying a retention condition.
7. The step of obtaining a test result of the observation sub-data in the first observation data includes: performing a normalization process on the first observation residual matrix according to the first measurement update matrix, the first measurement variance matrix, and the first state covariance matrix to obtain a normalized residual matrix; testing the normalized residual matrix, each element of which is associated with one observation sub-data in the first observation data, based on a second residual covariance matrix constructed based on the first measurement update matrix, the first measurement variance matrix, and the first state covariance matrix to obtain a test result corresponding to each element in the normalized residual matrix; The method of claim 6 , further comprising the step of: determining a test result corresponding to each element in the normalized residual matrix as a test result for a corresponding observation sub-data in the first observation data.
8. The step of correcting the first correction result using the double difference observation data to obtain a second correction result includes: determining second state parameters of a second filter based on the first correction result, and obtaining a second state covariance matrix corresponding to the second state parameters; obtaining a double-differenced observed residual matrix based on the double-differenced observed data and the second state parameters in response to the double-differenced observed data satisfying a second screening condition; determining a doubly-differenced measurement update matrix and a doubly-differenced measurement covariance matrix corresponding to the doubly-differenced observation residual matrix; determining a second parameter increment based on the double-differenced observation residual matrix, the double-differenced measurement update matrix, the double-differenced measurement variance matrix, and the second state covariance matrix, and setting the sum of the second parameter increment and the second state parameter as an updated second state parameter of the second filter; and obtaining the second correction result based on the updated second state parameter in response to the updated second state parameter satisfying a second reference condition.
9. The step of obtaining a double-differenced observation residual matrix based on the double-differenced observation data and the second state parameters includes: obtaining double difference estimation data based on the second state parameters; and constructing the doubly-differenced observed residual matrix based on the doubly-differenced observed data and the doubly-differenced estimated data.
10. The updated second state parameters include a position float solution and an integer bias float solution, and the step of obtaining the second correction result based on the updated second state parameters includes: fixing the float solution of the integer bias; responsive to the integer bias float solution being successfully fixed, calculating a position fixed solution using the integer bias fixed solution, and defining the result including the position fixed solution as the second correction result; and in response to the integer bias float solution being unsuccessful, making the second corrected result a result including the position float solution.
11. The target data includes the first observation data and the double difference observation data, and the step of acquiring the target positioning result based on the first positioning result based on the target data includes: locating a position of the mobile device using the first observation data to obtain a second positioning result; positioning the mobile device using the double difference observation data to obtain a third positioning result; The method of claim 2 , further comprising: fusing the first positioning result, the second positioning result and the third positioning result, and obtaining a fused result as the target positioning result.
12. The step of locating the position of the mobile device using the first observation data to obtain a second positioning result includes: The method according to claim 11 , further comprising the steps of: decomposing state parameters of the mobile device based on the first observation data; and obtaining the second positioning result based on the state parameters obtained by the decomposition.
13. The step of decomposing state parameters of the mobile device based on the first observation data includes: obtaining an initial observation residual matrix based on the first observation data and an initial positioning result; determining an initial Jacobian matrix and an initial measurement variance matrix corresponding to an initial observation residual matrix; obtaining a positioning result correction amount based on the initial observation residual matrix, the initial Jacobian matrix, and the initial measurement variance matrix, and calculating a sum of the positioning result correction amount and the initial positioning result as an intermediate positioning result; and obtaining decomposed derived state parameters based on the intermediate positioning results in response to the intermediate positioning results satisfying a first selection condition.
14. The step of fusing the first positioning result, the second positioning result, and the third positioning result, and setting the result obtained by fusing as the target positioning result, includes: obtaining a first weight corresponding to the first positioning result, a second weight corresponding to the second positioning result, and a third weight corresponding to the third positioning result; and fusing the first positioning result, the second positioning result, and the third positioning result based on the first weight, the second weight, and the third weight, and setting the fused result as the target positioning result.
15. The step of fusing the first positioning result, the second positioning result, and the third positioning result, and setting the result obtained by fusing as the target positioning result, includes: fusing any two of the first positioning result, the second positioning result, and the third positioning result to obtain a fusion result; The method according to claim 11 , further comprising: fusing the fusion result with an unfused positioning result, and obtaining a fusion result as the target positioning result.
16. The step of positioning the mobile device using the point cloud data to obtain a first positioning result includes: Matching the point cloud data with historical point cloud data located in one frame before the point cloud data to obtain point cloud matching information; determining a position change amount based on the point cloud matching information; The method according to any one of claims 1 to 15, further comprising: correcting a historical position of the mobile device based on the amount of position change to obtain a first position; and setting a positioning result including the first position as the first positioning result.
17. The target data includes the first observation data and the double difference observation data, and the step of acquiring the target positioning result based on the first positioning result based on the target data includes: correcting the first positioning result using the double difference observation data to obtain a third corrected result; The method according to claim 2 , further comprising: correcting the third correction result using the first observation data to obtain a fourth correction result, and setting the fourth correction result as the target positioning result.
18. The target data includes the first observation data and the double difference observation data, and the step of acquiring the target positioning result based on the first positioning result based on the target data includes: correcting the first positioning result using the first observation data to obtain a first corrected result; positioning the mobile device using the double difference observation data to obtain a third positioning result; The method of claim 2 , further comprising: fusing the first correction result and the third positioning result, and setting the fused result as the target positioning result.
19. The target data includes the first observation data and the double difference observation data, and the step of acquiring the target positioning result based on the first positioning result based on the target data includes: correcting the first positioning result using the double difference observation data to obtain a third corrected result; locating a position of the mobile device using the first observation data to obtain a second positioning result; The method of claim 2 , further comprising: fusing the third correction result with the second positioning result, and setting the fused result as the target positioning result.
20. The target data includes the first observation data and the double difference observation data, and the step of acquiring the target positioning result based on the first positioning result based on the target data includes: correcting the first positioning result using the first observation data to obtain a first corrected result; correcting the first positioning result using the double difference observation data to obtain a third corrected result; The method of claim 2 , further comprising: fusing the third correction result with the first correction result, and setting the fused result as the target positioning result.
21. The target data includes the first observation data and the double difference observation data, and the step of acquiring the target positioning result based on the first positioning result based on the target data includes: locating a position of a mobile device using the first observation data to obtain a second positioning result; correcting the second positioning result using the double difference observation data to obtain a fifth corrected result; The method according to claim 2 , further comprising: fusing the fifth correction result with the first positioning result, and setting the fused result as the target positioning result.
22. The target data includes the first observation data and the double difference observation data, and the step of acquiring the target positioning result based on the first positioning result based on the target data includes: positioning a mobile device using the double difference observation data to obtain a third positioning result; correcting the third positioning result using the first observation data to obtain a sixth corrected result; The method of claim 2 , further comprising: fusing the sixth correction result with the first positioning result, and setting the fused result as the target positioning result.
23. The target data includes the first observation data and the double difference observation data, and the step of acquiring the target positioning result based on the first positioning result based on the target data includes: locating a position of a mobile device using the first observation data to obtain a second positioning result; fusing the first positioning result and the second positioning result to obtain a first fusion result; The method of claim 2 , further comprising: correcting the first fusion result using the double difference observation data, and setting the corrected result as the target positioning result.
24. The target data includes the first observation data and the double difference observation data, and the step of acquiring the target positioning result based on the first positioning result based on the target data includes: positioning the mobile device using the double difference observation data to obtain a third positioning result; fusing the first positioning result and the third positioning result to obtain a second fusion result; The method of claim 2 , further comprising: correcting the second fusion result using the first observation data, and setting the corrected result as the target positioning result.
25. The target data includes the first observation data, and the step of acquiring the target positioning result based on the first positioning result based on the target data includes: correcting the first positioning result using the first observation data to obtain a first corrected result, and setting the first corrected result as the target positioning result; or 3. The method of claim 2, further comprising: positioning the mobile device using the first observation data to obtain a second positioning result; fusing the first positioning result and the second positioning result; and setting the fused result as the target positioning result.
26. The target data includes the double difference observation data, and the step of acquiring the target positioning result based on the first positioning result based on the target data includes: correcting the first positioning result using the double difference observation data to obtain a third corrected result, and setting the third corrected result as the target positioning result; or The method of claim 2 , further comprising: positioning the mobile device using the double difference observation data to obtain a third positioning result; fusing the first positioning result and the third positioning result; and setting the fused result as the target positioning result.
27. A first acquisition unit that acquires point cloud data scanned by a radar attached to a mobile device; a positioning unit that uses the point cloud data to position the mobile device and obtain a first positioning result; a second acquisition unit for acquiring first observation data received by a satellite positioning device attached to the mobile device; and a third acquisition unit for acquiring a target positioning result of the mobile device based on the first observation data and the first positioning result.
28. A computing device comprising a processor and a memory having stored therein at least one computer program which, when loaded and executed by said processor, causes said computing device to implement a positioning method according to any one of claims 1 to 26.
29. A non-volatile computer readable storage medium having stored thereon at least one computer program which, when loaded and executed by a processor, causes a computer to implement the positioning method according to any one of claims 1 to 26.
30. A computer program product comprising a computer program or computer instructions which, when loaded and executed by a processor, causes a computer to implement the positioning method according to any one of claims 1 to 26.
31. A computer program comprising computer instructions which, when loaded and executed by a processor, cause the computer to implement the positioning method according to any one of claims 1 to 26.
Citation Information
Patent Citations
Positioning method and device
CN111708043A
Terminal positioning method and device, equipment and medium
CN114384569A
Positioning method, positioning system, vehicle and computer readable storage medium
CN114509774A
Moving body position specification device
JP2010145178A
Inertial GPS navigation system with modified kalman filter
US20040150557A1
