Positioning method, apparatus, device and storage medium
Patent Information
- Application Number
- HK42024087254
- Authority / Receiving Office
- HK · HK
- Patent Type
- Patents
- Current Assignee / Owner
- Filing Date
- 2024-02-19
- Publication Date
- 2026-09-11
AI Technical Summary
In existing technologies, the positioning accuracy of mobile devices is limited by the quality of observation data, resulting in inaccurate positioning and poor robustness, making it difficult to meet practical needs.
By combining point cloud data scanned by radar with observation data received by satellite positioning equipment, data fusion and correction are performed in multiple ways to obtain target positioning results, reducing reliance on the quality of a single data source.
It improves the accuracy and robustness of positioning, and can obtain relatively accurate target positioning results even when the data quality is poor, thus meeting actual positioning needs.
Smart Images

Figure 00000000_0000_ABST
Abstract
Description
Technical Field
[0001] This application relates to the field of navigation technology, and in particular to a positioning method, apparatus, device, and storage medium. Background Technology
[0002] With the development of navigation technology, there are more and more application scenarios that require positioning of mobile devices. For example, in delivery scenarios, it is necessary to locate the terminal of the delivery object; in autonomous driving scenarios, it is necessary to locate the in-vehicle terminal, etc.
[0003] In related technologies, the positioning results of mobile devices are calculated in real time based on the observation data received by the satellite positioning equipment installed on the mobile devices. The positioning accuracy of this positioning method is limited by the quality of the observation data. When the quality of the observation data is poor, inaccurate positioning and poor positioning robustness are very likely to occur, making it difficult to meet actual positioning needs. Summary of the Invention
[0004] This application provides a positioning method, apparatus, device, and storage medium, which can be used to improve positioning accuracy and robustness. The technical solution is as follows:
[0005] On one hand, embodiments of this application provide a positioning method, the method comprising:
[0006] Obtain point cloud data scanned by the radar installed on the mobile device, use the point cloud data to locate the mobile device, and obtain a first location result;
[0007] Acquire the first observation data received by the satellite positioning device installed on the mobile device;
[0008] Based on the first observation data and the first positioning result, the target positioning result of the mobile device is obtained.
[0009] On the other hand, a positioning device is provided, the device comprising:
[0010] The first acquisition unit is used to acquire point cloud data scanned by the radar installed on the mobile device;
[0011] A positioning unit is used to locate the mobile device using the point cloud data to obtain a first positioning result;
[0012] The second acquisition unit is used to acquire the first observation data received by the satellite positioning device installed on the mobile device;
[0013] The third acquisition unit is used to acquire the target positioning result of the mobile device based on the first observation data and the first positioning result.
[0014] In one possible implementation, the third acquisition unit is configured to acquire target data based on the first observation data, the target data including at least one of the first observation data and double-difference observation data, the double-difference observation data being calculated based on the first observation data and reference observation data received by a satellite positioning device installed at a reference station; and to acquire the target positioning result based on the target data and the first positioning result.
[0015] In one possible implementation, the target data includes the first observation data and the double-difference observation data. The third acquisition unit is used to correct the first positioning result using the first observation data to obtain a first corrected result; to correct the first corrected result using the double-difference observation data to obtain a second corrected result; and to use the second corrected result as the target positioning result.
[0016] In one possible implementation, the third acquisition unit is configured to: acquire first state parameters of the first filter based on the first positioning result; acquire a first state covariance matrix corresponding to the first state parameters; in response to the first observation data satisfying a first screening condition, acquire a first observation residual matrix based on the first observation data and the first state parameters; determine a first measurement update matrix and a first measurement variance matrix corresponding to the first observation residual matrix; determine 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 use the sum of the first parameter increment and the first state parameters as the updated first state parameters of the first filter; in response to the updated first state parameters satisfying a first reference condition, acquire the first correction result based on the updated first state parameters.
[0017] In one possible implementation, the device further includes:
[0018] The determining unit is configured to: determine the covariance increment based on the first measurement update matrix, the first measurement variance matrix, and the first state covariance matrix; multiply the covariance increment by the first state covariance matrix to obtain the updated first state covariance matrix; perform a correction detection on the first parameter increment based on the updated first state covariance matrix; in response to the correction detection passing, test the first observation residual matrix based on the first residual covariance matrix to obtain the test results corresponding to each element in the first observation residual matrix, wherein the 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 in response to the test results corresponding to each element in the first observation residual matrix all satisfying the test conditions, determine that the updated first state parameter satisfies the first reference condition.
[0019] In one possible implementation, the determining unit is further configured to determine the model validation parameter value corresponding to the first filter based on the first observation data, the first state parameter, and the first state covariance matrix; in response to the model validation parameter value being less than a first threshold, obtain the test results of the observation sub-data in the first observation data; and in response to the test results of the observation sub-data in the first observation data all satisfying the retention condition, determine that the first observation data satisfies the first screening condition.
[0020] In one possible implementation, the third acquisition unit is configured to: determine the second state parameters of the second filter based on the first correction result; acquire the second state covariance matrix corresponding to the second state parameters; in response to the double-difference observation data satisfying the second screening condition, acquire the double-difference observation residual matrix based on the double-difference observation data and the second state parameters; determine the double-difference measurement update matrix and the double-difference measurement variance matrix corresponding to the double-difference observation residual matrix; determine the 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 use the sum of the second parameter increment and the second state parameters as the updated second state parameters of the second filter; in response to the updated second state parameters satisfying the second reference condition, acquire the second correction result based on the updated second state parameters.
[0021] In one possible implementation, the updated second state parameter includes a floating-point solution for the position and a floating-point solution for the integer ambiguity. The third acquisition unit is used to fix the floating-point solution for the integer ambiguity; in response to successful fixing, it calculates a fixed solution for the position using the fixed solution for the integer ambiguity, and uses the result including the fixed solution for the position as the second correction result; in response to unsuccessful fixing, it uses the result including the floating-point solution for the position as the second correction result.
[0022] In one possible implementation, the target data includes the first observation data and the double-difference observation data. The third acquisition unit is used to locate the mobile device using the first observation data to obtain a second positioning result; to locate the mobile device using the double-difference observation data to obtain a third positioning result; and to fuse the first positioning result, the second positioning result, and the third positioning result, and use the fused result as the target positioning result.
[0023] In one possible implementation, the third acquisition unit is used to calculate the state parameters of the mobile device based on the first observation data, and to acquire the second positioning result based on the calculated state parameters.
[0024] In one possible implementation, the third acquisition unit is used to acquire 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; based on the first weight, the second weight, and the third weight, the first positioning result, the second positioning result, and the third positioning result are fused, and the fused result is used as the target positioning result.
[0025] In one possible implementation, the positioning unit is configured to match the point cloud data with historical point cloud data in the previous frame to obtain point cloud matching information; determine the position change based on the point cloud matching information; correct the historical position of the mobile device based on the position change to obtain a first position; and use the positioning result including the first position as the first positioning result.
[0026] In one possible implementation, the target data includes the first observation data and the double-difference observation data. The third acquisition unit is used to correct the first positioning result using the double-difference observation data to obtain a third corrected result; to correct the third corrected result using the first observation data to obtain a fourth corrected result; and to use the fourth corrected result as the target positioning result.
[0027] In one possible implementation, the target data includes the first observation data. The third acquisition unit is used to correct the first positioning result using the first observation data to obtain a first correction result, and use the first correction result as the target positioning result; or, it uses the first observation data to locate the mobile device to obtain a second positioning result, fuses the first positioning result and the second positioning result, and uses the fused result as the target positioning result.
[0028] In one possible implementation, the target data includes the double-difference observation data. The third acquisition unit is used to correct the first positioning result using the double-difference observation data to obtain a third corrected result, and to use the third corrected result as the target positioning result; or, to locate the mobile device using the double-difference observation data to obtain a third positioning result, to fuse the first positioning result and the third positioning result, and to use the fused result as the target positioning result.
[0029] On the other hand, a computer device is provided, the computer device including a processor and a memory, the memory storing at least one computer program, the at least one computer program being loaded and executed by the processor to enable the computer device to implement any of the positioning methods described above.
[0030] On the other hand, a computer-readable storage medium is also provided, wherein at least one computer program is stored therein, the at least one computer program being loaded and executed by a processor to enable a computer to implement any of the positioning methods described above.
[0031] On the other hand, a computer program product is also provided, which includes a computer program or computer instructions, which are loaded and executed by a processor to enable a computer to implement any of the positioning methods described above.
[0032] The technical solution provided in this application has at least the following beneficial effects:
[0033] The technical solution provided in this application provides that the final target positioning result of the mobile device is obtained by comprehensively considering the point cloud data scanned by the radar installed on the mobile device and the first observation data received by the satellite positioning device. The point cloud data and the first observation data can complement each other. This positioning method can reduce the dependence on either the point cloud data or 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 considering the other data. The positioning robustness is good and it is conducive to meeting actual positioning needs. Attached Figure Description
[0034] To more clearly illustrate the technical solutions in the embodiments of this application, the accompanying drawings used in the description of the embodiments will be briefly introduced below. Obviously, the accompanying drawings described below are only some embodiments of this application. For those skilled in the art, other drawings can be obtained based on these drawings without creative effort.
[0035] Figure 1 This is a comparison chart of the effects of single-point localization and RTK differential localization;
[0036] Figure 2 This is a schematic diagram of the implementation environment of a positioning method provided in an embodiment of this application;
[0037] Figure 3 This is a flowchart of a positioning method provided in an embodiment of this application;
[0038] Figure 4 This is a schematic diagram illustrating a process of using point cloud data to locate a mobile device and obtain a first location result, as provided in an embodiment of this application.
[0039] Figure 5 This is a flowchart illustrating an implementation process for obtaining a target positioning result based on a first positioning result, according to an embodiment of this application.
[0040] Figure 6 This is a schematic diagram of the correlation processing of a first filter provided in an embodiment of this application;
[0041] Figure 7 This is a flowchart illustrating an implementation process for obtaining a target positioning result based on a first positioning result, according to an embodiment of this application.
[0042] Figure 8 This is a schematic diagram illustrating a process for calculating the state parameters of a mobile device based on first observation data, as provided in an embodiment of this application.
[0043] Figure 9 This is a schematic diagram illustrating a process of estimating the position and clock bias of a mobile device using robust weighted least squares, as provided in an embodiment of this application.
[0044] Figure 10 This is a schematic diagram illustrating a process of estimating the speed and clock drift of a mobile device using robust weighted least squares, as provided in an embodiment of this application.
[0045] Figure 11 This is a schematic diagram of the framework of a positioning method provided in an embodiment of this application;
[0046] Figure 12 This is a schematic diagram illustrating the detailed process of a positioning method provided in an embodiment of this application;
[0047] Figure 13 This is a schematic diagram illustrating an application scenario of a positioning method provided in an embodiment of this application;
[0048] Figure 14 This is a schematic diagram illustrating an application scenario of a positioning method provided in an embodiment of this application;
[0049] Figure 15 This is a schematic diagram of a positioning device provided in an embodiment of this application;
[0050] Figure 16 This is a schematic diagram of the structure of a mobile device provided in an embodiment of this application;
[0051] Figure 17 This is a schematic diagram of the structure of a server provided in an embodiment of this application. Detailed Implementation
[0052] To make the objectives, technical solutions, and advantages of this application clearer, the embodiments of this application will be described in further detail below with reference to the accompanying drawings.
[0053] The following explanations are provided for some of the terms used in the embodiments of this application.
[0054] A Global Navigation Satellite System (GNSS), also known as a Global Navigation Satellite System, is a space-based radio navigation and positioning system that provides users with all-weather 3D coordinates, velocity, and time information at any location on the Earth's surface or in near-Earth space. Common GNSS systems include the Global Positioning System (GPS), the BeiDou Navigation Satellite System (BDS), GLONASS, and Galileo. GPS was the earliest and most technologically advanced system. In recent years, with the full-scale service launch of BDS and GLONASS in some regions, especially BDS, its development in the civilian sector has accelerated. GNSS systems are now widely used in communications, positioning, consumer entertainment, surveying and mapping, vehicle management, and automotive navigation and information services.
[0055] Satellite positioning equipment (also known as a satellite signal receiver) is an electronic device used to receive and process satellite signals and measure the geometric distance (pseudorange observation) between a mobile device and a satellite, as well as the Doppler effect of the satellite signal (Doppler observation). Satellite positioning equipment typically includes modules such as an antenna, a satellite signal receiving loop, and baseband signal processing. Mobile devices integrating satellite positioning equipment calculate their current position coordinates based on pseudorange and Doppler observations. Satellite positioning equipment is widely used in map navigation, surveying, location services, and deep space exploration, such as smartphone map navigation and high-precision geodesy. The observation data output by satellite positioning equipment includes pseudorange, pseudorange rate, and accumulated distance increment (ADR); pseudorange measures the geometric distance between the satellite and the satellite positioning equipment; pseudorange rate observation measures the Doppler effect caused by the relative motion between the satellite positioning equipment and the satellite; and ADR measures the change in the geometric distance between the satellite and the satellite positioning equipment.
[0056] Pseudorange: This refers to the approximate distance between a ground receiver (e.g., a satellite positioning device installed on a mobile device) and the satellite during satellite positioning. Assuming the satellite clock and receiver clock are strictly synchronized, the signal propagation time can be obtained from the satellite signal transmission time and the receiver reception time. Multiplying this by the propagation speed gives the satellite-to-ground distance. However, clock discrepancies are inevitable, and the signal is also affected by atmospheric refraction and other factors during propagation. Therefore, the distance directly measured using this method does not equal the true distance between the satellite and the ground receiver; hence, this distance is called pseudorange. In the embodiments of this application, the pseudorange observation data refers to the distance observation data between the satellite and the mobile device.
[0057] CORS (Continuously Operating Reference Stations) system: The CORS system is a product of the comprehensive and in-depth integration 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 broadcasting system, and a user application system. Each reference station and the detection and analysis center are connected to each other through the data transmission system to form a dedicated network.
[0058] RTK (Real-Time Kinematic) differential positioning technology, also known as carrier phase differential positioning technology, is a real-time dynamic positioning technology based on carrier phase observations. It provides real-time three-dimensional positioning results of a station in a specified coordinate system with centimeter-level accuracy. In RTK positioning mode, the base station transmits its observations and station coordinates to the rover via a data link. The rover not only receives data from the base station via the data link but also collects satellite observation data for real-time processing. Compared to traditional single-point positioning, RTK differential positioning eliminates the effects of atmospheric delay errors, satellite clock errors, and terminal receiver clock errors. It also eliminates the effects of space system errors, propagation errors, and environmental errors, resulting in superior positioning accuracy and stability compared to traditional single-point positioning. For example, a comparison chart of the effects of single-point positioning and RTK differential positioning can be shown as follows: Figure 1 As shown. The positioning error of traditional single-point positioning is 5-20m, while the positioning error of RTK differential positioning is 3-5cm.
[0059] LiDAR: A distance sensor that uses infrared light as a laser source is also known as lidar. It uses a reflection principle similar to radar. Obstacles within the effective range of the laser cause reflection due to blocking the light source, thereby obtaining 3D (three-dimensional) obstacle distance information on the same plane as the laser source. Based on the obtained information, matching and positioning or pose calculation can be performed. Currently, more and more mobile devices are equipped with lidar.
[0060] Quartiles, also known as quartiles, are the points at which all data are arranged in ascending order and divided into four equal parts, each containing 25% of the data. There are three quartiles: the lower quartile (Q1), the median, and the upper quartile (Q3). The first quartile (Q1), also called the lower quartile, is equal to the 25th percentile of the data when arranged in ascending order. The second quartile (Q2), also called the median, is equal to the 50th percentile of the data when arranged in ascending order. The third quartile (Q3), also called the upper quartile, is equal to the 75th percentile of the data when arranged in ascending order.
[0061] Pseudorange observation data: The approximate distance between the satellite signal receiver (e.g., satellite positioning equipment) and the satellite during satellite positioning.
[0062] Doppler observation data: Doppler measurements or Doppler counts of radio signals transmitted by satellites, determined by a satellite signal receiver.
[0063] Carrier phase observation data: The phase difference between the carrier signal or subcarrier signal transmitted by the satellite and the local oscillator signal of the satellite signal receiver.
[0064] Elevation angle: The angle between the direction line from the point where the satellite signal receiver is located and the horizontal plane.
[0065] Clock bias: Clock error. In this application, clock bias specifically refers to satellite clock bias and mobile device clock bias. Satellite clock bias is the difference between satellite clock and standard time. Mobile device clock bias can also be called receiver clock bias, which is the difference between receiver clock and standard time.
[0066] Clock drift: Clock bias change rate. In this application, clock drift specifically refers to mobile device clock drift and satellite clock drift. Mobile device clock drift refers to receiver clock bias change rate, and satellite clock drift refers to satellite clock bias change rate.
[0067] Epoch: The starting point of a period or event, or a reference date for a measurement system. To compare observations at different times, the observation time corresponding to the data needs to be specified; this time is called the observation epoch.
[0068] Figure 2 This is a schematic diagram of the implementation environment of a positioning method provided in an embodiment of this application. See also... Figure 2 The implementation environment may include mobile device 110, reference station 120, satellite cluster 130 and server 140.
[0069] Mobile device 110 is connected to server 140 via a wireless or wired network. Optionally, mobile device 110 may be a mobile phone, computer, smart voice interaction device, smart home appliance, vehicle terminal, aircraft, etc., but is not limited to these. Mobile device 110 has an application that supports location services installed and running. In some embodiments, mobile device 110 runs a navigation application, which allows users to perform navigation functions. In some embodiments, mobile device 110 is equipped with a satellite positioning device, which enables mobile device 110 to communicate with satellite cluster 130 to obtain observation data. In some embodiments, mobile device 110 is equipped with radar, which can scan point cloud data around mobile device 110.
[0070] Optionally, reference station 120 is a CORS system. Reference station 120 can communicate with satellite constellation 130 to obtain parameters of each satellite in satellite constellation 130. Of course, reference station 120 can also communicate with mobile device 110 or server 140 to send navigation ephemeris and raw observation data of satellite constellation to mobile device 110 or server 140.
[0071] Optionally, server 140 may be a standalone physical server, 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 communication, middleware services, domain name services, security services, Content Delivery Network (CDN), and big data and artificial intelligence platforms. In some embodiments, server 140 may communicate with mobile device 110, and server 140 may provide navigation-related computing services (e.g., differential service broadcasting, location reporting, etc.). In some embodiments, server 140 may also be referred to as a high-precision positioning server platform.
[0072] The positioning method provided in this application embodiment can be executed by the mobile device 110, the server 140, or both the mobile device 110 and the server 140. This application embodiment does not limit this.
[0073] Those skilled in the art should understand that the mobile device 110, reference station 120, satellite cluster 130 and server 140 described above are merely examples. Other existing or future mobile devices, reference stations, satellite clusters or servers that are applicable to this application should also be included within the scope of protection of this application, and are hereby incorporated by reference.
[0074] For example, the positioning method provided in this application can be applied to vehicle scenarios, the mapping field, and the transportation field, etc. In the transportation field, Intelligent Traffic System (ITS), also known as Intelligent Transportation System, effectively integrates advanced science and technology (information technology, computer technology, data communication technology, sensor technology, electronic control technology, automatic control theory, operations research, artificial intelligence, etc.) into transportation, service control, and vehicle manufacturing, strengthening the connection between vehicles, roads, and users, thereby forming a comprehensive transportation system that ensures safety, improves efficiency, improves the environment, and saves energy.
[0075] Intelligent Vehicle Infrastructure Cooperative Systems (IVICS) are a development direction of Intelligent Transportation Systems (ITS). IVICS utilizes advanced wireless communication and next-generation Internet technologies to implement comprehensive, real-time dynamic information exchange between vehicles and infrastructure. Based on the collection and fusion of dynamic traffic information across all times and spaces, it conducts active vehicle safety control and cooperative road management, fully realizing effective collaboration between people, vehicles, and roads. This ensures traffic safety, improves traffic efficiency, and ultimately forms a safe, efficient, and environmentally friendly road traffic system.
[0076] Based on the above Figure 2 The implementation environment shown in this application provides a positioning method, taking the application of this method to a mobile device 110 as an example. Figure 3 As shown, the positioning method provided in this application embodiment may include the following steps 301 to 303.
[0077] In step 301, point cloud data scanned by the radar installed on the mobile device is acquired, and the mobile device is located using the point cloud data to obtain the first location result.
[0078] The mobile device is equipped with radar that 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 point cloud data acquired in this embodiment refers to the point cloud data scanned by the radar at the current positioning time.
[0079] For example, the radar installed on a mobile device can be a lidar (Light Detection and Ranging) system. Lidar detects obstacles within its effective range by emitting laser light. By emitting laser light, it can scan for information about obstacles on the same plane as the laser source, and this obstacle information can be represented using point cloud data. For example, point cloud data can refer to three-dimensional point cloud data or two-dimensional point cloud data. Point cloud data is a dataset of points in a coordinate system, and the data for each point can include location information, color information, reflection intensity information, etc.
[0080] The acquisition of point cloud data is related to radar. Regardless of the quality of the GNSS signal, the radar installed on the mobile device can scan the point cloud data and obtain the first positioning result of the mobile device based on the point cloud data. This first positioning result provides data support for the acquisition of the final target positioning result, reduces the dependence of the target positioning result on the quality of the GNSS signal, and thus improves the accuracy and robustness of the target positioning result.
[0081] In an exemplary embodiment, the process of locating a mobile device using point cloud data to obtain a first location result includes: matching the point cloud data with historical point cloud data in the previous frame to obtain point cloud matching information; determining the position change based on the point cloud matching information; correcting the historical position of the mobile device based on the position change to obtain a first position; and using the location result including the first position as the first location result.
[0082] For example, the historical point cloud data in the previous frame can refer to the point cloud data scanned by the radar installed on the mobile device at the previous scan time. The process of matching the point cloud data with the historical point cloud data in the previous frame can be implemented based on the NDT (Normal Distributions Transform) algorithm. NDT can determine the optimal match between two point clouds through standard optimization techniques. Because it does not utilize the feature calculation and matching of corresponding points during the registration process, the matching speed is faster than other methods. The NDT registration algorithm is time-stable, has low dependence on initial values, and can effectively correct large initial value errors.
[0083] This point cloud matching information indicates the point cloud matching relationship between the current point cloud data and historical point cloud data from the previous frame. Based on this information, the position change can be determined, indicating the change in the current position relative to historical positions. Historical positions refer to the positions in historical positioning results, which can be the positioning results from the time preceding the current positioning time.
[0084] After determining the change in location, the historical location of the mobile device is corrected based on the change in location to obtain a first location. The first location can be regarded as the current location of the mobile device determined based on point cloud data. For example, the first location can be obtained by correcting the historical location of the mobile device based on the change in location by using the sum of the change in location and the historical location as the first location.
[0085] For example, the accuracy of the position change determined based on point cloud matching information may be poor. After obtaining the position change, a correction equation corresponding to the position change can be determined. This correction equation indicates how to correct the historical position of the mobile device based on the position change. For example, the position change is substituted into the correction equation for an unknown position change to obtain the correction equation corresponding to the unknown position change. The correction equation for an unknown position change can be set based on experience.
[0086] After determining the correction equation corresponding to the position change, the historical position of the mobile device is corrected based on the correction equation, and the corrected position is taken as the first position. For example, the correction equation corresponding to the position change can be an equation with the position to be corrected as the independent variable and the corrected position as the dependent variable. The method for correcting the historical position of the mobile device based on the correction equation to obtain the first position can be: substituting the value of the historical position as the independent variable into the correction equation, and taking the calculated value of the dependent variable as the first position.
[0087] For example, the method of obtaining the first position by correcting the historical position of the mobile device based on the position change can also be as follows: the sum of the position change and the historical position of the mobile device is used as a reference position; the reference position is then filtered and corrected using a reference filter to obtain the first position. The reference filter can be any filter; for example, the type of reference filter can include, but is not limited to, a Kalman filter (EF), an Extended Kalman filter (EKF), an unscented Kalman filter, a robust Kalman filter, etc. During 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 required for filtering and correction (e.g., measurement update matrix, measurement variance matrix, etc.) can be set according to the matching degree of the point cloud matching information.
[0088] After determining the first location, the positioning result including the first location is used as the first positioning result of the mobile device. This application embodiment does not limit the type of parameters included in the first positioning result, as long as the type of parameters included in the first positioning result includes a location type. For example, the type of parameters included in the first positioning result may include both location and speed types. For example, if the type of parameters included in the first positioning result also includes a speed type, the speed from historical positioning results can be used as the speed in the first positioning result, or a speed set based on experience can be used as the speed in the first positioning result, etc. This application embodiment does not limit this.
[0089] For example, the process of using point cloud data to locate a mobile device and obtain the first location result can be as follows: Figure 4 As shown, first, point cloud data scanned by the radar installed on the mobile device is acquired; then, the point cloud data and historical point cloud data in the previous frame are matched based on the NDT algorithm to obtain the position change; the constraint equation corresponding to the position change is determined; the historical position is corrected based on the constraint equation corresponding to the position change to obtain the first position, and the positioning result including the first position is used as the first positioning result.
[0090] In step 302, the first observation data received by the satellite positioning device installed on the mobile device is acquired.
[0091] The mobile device is equipped with a satellite positioning device that 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 the first observation data acquired in this embodiment refers to the observation data received by the satellite positioning device at the current positioning time. For example, the first observation data may include at least one of first pseudorange observation data, first Doppler observation data, and first carrier phase observation data.
[0092] For example, the first observation data refers to the observation data for a first satellite, that is, the observation data between the first satellite and the mobile device. The first satellite refers to each satellite whose signal was acquired at the current positioning time of the mobile device. For example, there are multiple first satellites to ensure the accuracy of the positioning results obtained based on the observation data. The first observation data includes observation sub-data corresponding to the first satellite, and each first satellite has corresponding observation sub-data. When the first observation data includes first pseudorange observation data, the observation sub-data corresponding to any first satellite includes the pseudorange observation sub-data corresponding to any first satellite; when the first observation data includes first Doppler observation data, the observation sub-data corresponding to any first satellite includes the Doppler observation sub-data corresponding to any first satellite; when the first observation data includes first carrier phase observation data, the observation sub-data corresponding to any first satellite includes the carrier phase observation sub-data corresponding to any first satellite.
[0093] For example, a mobile device can connect to the CORS system via the NTRIP protocol, send an observation data acquisition request to the CORS system, and then the CORS system broadcasts the first observation data to the satellite positioning device installed on the mobile device, thereby enabling the satellite positioning device installed on the mobile device to receive the first observation data. Here, the NTRIP protocol refers to the Networked Transport of RTCM via Internet Protocol, and RTCM refers to the protocol developed by the Radio Technical Commission for Maritime Services.
[0094] For example, in addition to sending observation data broadcasting requests to the CORS system, the mobile device can also send ephemeris acquisition requests. Upon receiving the ephemeris acquisition request, the CORS system can retrieve the navigation ephemeris of the first satellite from its satellite ephemeris database and transmit it to the mobile device, thereby enabling the mobile device to acquire the navigation ephemeris of the first satellite. The navigation ephemeris of the first satellite may include a list of parameters used to determine the state information of the first satellite. For example, the CORS system can transmit the navigation ephemeris of the first satellite to the mobile device in the form of a binary stream.
[0095] For example, a mobile device can obtain the status information of a first satellite based on the first observation data and the navigation ephemeris of the first satellite. When the first observation data only includes the first pseudorange observation data, the status information of the first satellite includes the satellite position and the satellite clock bias. When the first observation data only includes the first Doppler observation data, the status information of the first satellite includes the satellite velocity (i.e., the satellite's orbital speed) and the satellite clock drift. When the first observation data includes both the first pseudorange observation data and the first Doppler observation data, the satellite status information includes the satellite position, the satellite clock bias, the satellite velocity, and the satellite clock drift.
[0096] For example, the number of first satellites can be N (N is a positive integer). Each first satellite at any given time 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. The satellite position, satellite clock bias, satellite velocity, and satellite clock drift corresponding to each satellite can be different. For instance, when the first observation data includes first pseudorange observation data, the satellite position and satellite clock bias corresponding to each first satellite can be calculated based on the received first pseudorange observation data and the navigation ephemeris of the first satellites; when the first observation data includes first Doppler observation data, the satellite velocity and satellite clock drift corresponding to each satellite can be calculated based on the received first Doppler observation data and the navigation ephemeris of the first satellites.
[0097] For example, the location involved in the embodiments of this application may refer to the location in the Earth-Centered Earth Fixed (ECEF) coordinate system. The ECEF coordinate system has the Earth's center O as the origin, the Z-axis pointing to the North Pole of the conventional Earth, and the X-axis pointing to the intersection of the Prime Meridian and the Earth's equator. The X, Y, and Z axes together form a right-handed rectangular coordinate system.
[0098] For example, when acquiring the first observation data, the signal-to-noise ratio (SNR) and the elevation angle of the first satellite can also be acquired. SNR, also known as carrier-to-noise ratio, is a standard measurement scale used to represent the relationship between a carrier wave and carrier noise. Each observation sub-data corresponding to the first satellite in the first observation data has its own SNR. The SNR of different types of observation sub-data corresponding to any satellite may be the same or different. For example, the elevation angle of the first satellite refers to the angle between the direction line connecting the satellite positioning device installed on the mobile device and the first satellite and the horizontal plane of the mobile device. For example, the SNR and elevation angle of the first observation data can be determined by the CORS system based on the first observation data and sent to the mobile device, or they can be determined by the mobile device itself based on the first observation data; this embodiment does not limit this.
[0099] In step 303, the target positioning result of the mobile device is obtained based on the first observation data and the first positioning result.
[0100] The first observation data is the observation data received by the satellite positioning device installed on the mobile device. The first positioning result is the positioning result obtained by using the point cloud data scanned by the radar installed on the mobile device. Obtaining the target positioning result of the mobile device based on the first observation data and the first positioning result helps to reduce the dependence of the positioning process on either the point cloud data or the first observation data. Even if the quality of the point cloud data or the first observation data is poor, the accuracy of the target positioning result can be guaranteed by considering the other data, reducing the probability of failure to locate and improving the robustness of positioning.
[0101] In one possible implementation, the process of obtaining the 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.
[0102] Step 3031: Based on the first observation data, obtain target data. The target data includes at least one of the first observation data and double-difference observation data. The double-difference observation data is calculated based on the first observation data and the reference observation data received by the satellite positioning equipment installed at the reference station.
[0103] The target data refers to the data required to obtain the target positioning result based on the first positioning result. This target data is satellite observation data, which complements the point cloud data used to obtain the first positioning result, thereby improving positioning accuracy. For example, the target data may include only the first observation data, only double-difference observation data, or both. The specific type of target data can be set based on experience or flexibly adjusted according to the actual application scenario; this application does not limit this. For example, when the target data includes both first observation data and double-difference observation data, the satellite observation data used to obtain the target positioning result is more comprehensive, which is beneficial for further improving the accuracy of the target positioning result.
[0104] The implementation method for obtaining the target data based on the first observation data varies depending on the specific target data. For example, when the target data only includes the first observation data, the implementation method is to use the first observation data as the target data. For example, when the target data only includes double-difference observation data, the implementation method is to obtain the benchmark observation data; calculate the double-difference observation data based on the first observation data and the benchmark observation data; and use the double-difference observation data as the target data. For example, when the target data includes both the first observation data and the double-difference observation data, the implementation method is to obtain the target data based on the first observation data; obtain the benchmark observation data; calculate the double-difference observation data based on the first observation data and the benchmark observation data; and use the data including both the first observation data and the double-difference observation data as the target data.
[0105] The reference observation data refers to the observation data received by the satellite positioning equipment installed at the reference station. The reference station can be any base station equipped with satellite positioning equipment, and the observation data received by the satellite positioning equipment at the reference station for the first satellite is used as the reference observation data. The reference observation data includes reference observation sub-data corresponding to the first satellite. For example, 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.
[0106] For example, the reference station is a fixed and known base station, thereby providing data support for the positioning of mobile devices. For example, the reference observation data received by the satellite positioning equipment installed at the reference station can be obtained by communicating with the CORS system or by communicating with the reference station itself; this application embodiment does not limit this.
[0107] After acquiring the reference observation data, double-difference observation data can be calculated based on the first observation data and the reference observation data. For example, the first observation data includes the first pseudorange observation sub-data and the first carrier phase observation sub-data corresponding to the first satellite, and the reference observation data includes the reference pseudorange observation sub-data and the 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 also be other types, which will not be listed here.
[0108] For example, the pseudorange double-difference observation data includes pseudorange double-difference observation values corresponding to each of the other satellites in the first satellite group (excluding the reference satellite). The pseudorange double-difference observation value corresponding to any other satellite is the difference between the first pseudorange observation difference and the second pseudorange observation difference corresponding to that other satellite. The first pseudorange observation difference corresponding to any other satellite is the difference between the first pseudorange observation sub-data corresponding to the reference satellite and the first pseudorange observation sub-data corresponding to any other satellite. The second pseudorange observation difference corresponding to any other satellite is the difference between the reference pseudorange observation sub-data corresponding to the reference satellite and the reference pseudorange observation sub-data corresponding to any other satellite. The reference satellite can be any satellite in the first satellite group and can be selected based on experience.
[0109] For example, taking the first satellite 1 as the reference satellite, the pseudorange double-difference observation value corresponding to the first satellite 2 can be expressed as: in, This represents the first pseudorange observation sub-data corresponding to the first satellite 1. This represents the first pseudorange observation sub-data corresponding to the first satellite 2. This represents the reference pseudorange observation sub-data corresponding to the first satellite 1. This represents the reference pseudorange observation sub-data corresponding to the first satellite 2.
[0110] For example, the carrier phase double-difference observation data includes the carrier phase double-difference observation values corresponding to each of the other satellites in the first satellite (excluding the reference satellite). The carrier phase double-difference observation value corresponding to any other satellite is the difference between the first carrier phase observation difference value and the second carrier phase observation difference value corresponding to any other satellite. The first carrier phase observation difference value corresponding to any other satellite is the difference between the first carrier phase observation sub-data corresponding to the reference satellite and the first carrier phase observation sub-data corresponding to any other satellite. The second carrier phase observation difference value corresponding to any other satellite is the difference between the reference carrier phase observation sub-data corresponding to the reference satellite and the reference carrier phase observation sub-data corresponding to any other satellite.
[0111] For example, taking the first satellite 1 as the reference satellite, the carrier phase double difference observation value corresponding to the first satellite 2 can be expressed as: in, This represents the first carrier phase observation sub-data corresponding to the first satellite 1. This represents the first carrier phase observation sub-data corresponding to the first satellite 2. This represents the reference carrier phase observation sub-data corresponding to the first satellite 1. This represents the reference carrier phase observation sub-data corresponding to the first satellite 2.
[0112] For example, double-difference observation data is acquired based on first observation data received by a satellite positioning device installed on a mobile device and reference observation data received by a satellite positioning device installed on a reference station. Double-difference observation data not only considers the differences between observation sub-data from the same satellite received by the satellite positioning device installed on the mobile device and the satellite positioning device installed on the reference station, but also considers the differences between observation sub-data from different satellites received by the same satellite positioning device (either the satellite positioning device installed on the mobile device or the satellite positioning device installed on the reference station). By considering double-difference observation data, certain errors (such as atmospheric delay errors, satellite clock errors, and mobile device clock errors) can be eliminated, which is beneficial for improving positioning accuracy.
[0113] Step 3032: Based on the target data, obtain the target positioning result based on the first positioning result.
[0114] The target data may include only the first observation data, only the double-difference observation data, or both the first observation data and the double-difference observation data. Depending on the type of target data, the specific process for obtaining the target positioning result based on the first positioning result will differ. The specific process for obtaining the target positioning result based on the first positioning result will be described in detail below and will not be elaborated here.
[0115] For example, the process of obtaining the target positioning result based on the target data and the first positioning result is implemented according to the result acquisition method corresponding to the target data. The result acquisition method corresponding to the target data is used to indicate how to obtain the target positioning result based on the target data and the first positioning result. The result acquisition method corresponding to the target data can be set according to experience or flexibly adjusted according to the application scenario. This application embodiment does not limit this. For example, the result acquisition method corresponding to the target data is different in different situations; the result acquisition method corresponding to the target data in any situation may be any one of multiple candidate methods, and each candidate method corresponds to a specific implementation process.
[0116] It should be noted that steps 3031 and 3032 described above are an exemplary implementation of obtaining the target positioning result of the mobile device based on the first observation data and the first positioning result, and the embodiments of this application are not limited thereto. In some embodiments, the first observation data can be directly assumed to be the data required to obtain the target positioning result based on the first positioning result, thereby directly obtaining the target positioning result based on the first observation data and the first positioning result.
[0117] The positioning method provided in this application obtains the final target positioning result of the mobile device by comprehensively considering the point cloud data scanned by the radar installed on the mobile device and the first observation data received by the satellite positioning device. The point cloud data and the first observation data can complement each other. This positioning method can reduce the dependence on either the point cloud data or 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 considering the other data. The positioning robustness is good and it is conducive to meeting actual positioning needs.
[0118] This application provides a process for obtaining a target positioning result based on target data and a first positioning result. This process is specifically implemented when the target data includes first observation data and double-difference observation data. Taking the application of this method to a mobile device 110 as an example... Figure 5 As shown, the method provided in this application embodiment may include the following steps 501 and 502.
[0119] In step 501, the first positioning result is corrected using the first observation data to obtain the first corrected result.
[0120] The first correction result refers to the result after correcting the first positioning result using the first observation data. For example, the types of parameters included in the first correction result are the same as the types of parameters included in the first positioning result. For example, the process of correcting the first positioning result using the first observation data can be implemented using a first filter. The first filter can be any filter; for example, 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 this application embodiment does not limit this.
[0121] In one possible implementation, see [link to relevant documentation]. Figure 5 The 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.
[0122] Step 5011: Obtain the first state parameters of the first filter based on the first positioning result, and obtain the first state covariance matrix corresponding to the first state parameters.
[0123] The first state parameter is the state parameter to be updated of the first filter. For example, the type of the parameter in the state parameter of the first filter includes the type of parameter in the positioning result of the mobile device. For example, taking the type of parameter in the positioning result of the mobile device as including location and speed, the state parameter can be represented as follows: in,[] T Represented as the transpose of a matrix, r u and v u These represent the speed and location of the mobile device, respectively, and dtr represents the clock bias of the mobile device (i.e., the receiver clock bias). This indicates clock drift in the mobile device (i.e., receiver clock drift). For example, r u and v u Let be the velocity and position in the ECEF coordinate system.
[0124] In an exemplary embodiment, the method for obtaining the first state parameter of the first filter based on the first positioning result can be: using the first positioning result as the first state parameter. In an exemplary embodiment, the method for obtaining the first state parameter of the first filter based on the first positioning result can also be: using the first positioning result as an initial state parameter, updating the initial state parameter over time to obtain the first state parameter.
[0125] The first-state covariance matrix can be used to characterize the correlation between first-state parameters. This first-state covariance matrix is a diagonal matrix and is also a symmetric matrix. For example, when the first positioning result is used as the first-state parameter, the first-state covariance matrix can be set empirically; for instance, it can be set to P = diag(100...). 2 100 2 100 2 100 2 ), where diag represents a diagonal matrix. For example, in the case where the first positioning result is used as the initial state parameter, and the initial state parameter is updated over time to obtain the first state parameter, the method for obtaining the first state covariance matrix corresponding to the first state parameter can be: obtain the initial state covariance matrix corresponding to the initial state parameter, update the initial covariance matrix over time, and use the covariance matrix obtained after the time update as the first state covariance matrix corresponding to the first state parameter.
[0126] The following example illustrates how the first state parameters are obtained by updating the initial state parameters over time, and the first state covariance matrix is obtained by updating the initial covariance matrix over time.
[0127] During the time update of the initial state parameters, the initial state parameters can be updated multiple times. Let the initial state parameters of the first filter be z(0) and the initial state covariance matrix of the first filter be P(0). z(0) can be considered as the state parameters of the first filter at time 0, and P(0) can be considered as the state covariance matrix of the first filter at time 0. The next state parameter (at time 1) of the first filter after time update can be denoted as z(1), and the next state covariance matrix can be denoted as P(1). Similarly, the state parameters of the first filter at time t can be denoted as z(t), and the state covariance matrix at time t can be denoted as P(t). Assuming the current time is time t, then z(t) is the first state parameter of the first filter, and P(t) is the first state covariance matrix of the first filter.
[0128] For example, the process of updating the initial state covariance matrix over time includes: assuming that at t k At time t, the state covariance matrix of the filter is P(t) k ), then at t k+1 At time t, the state covariance matrix of the filter is calculated based on the following formula 1:
[0129] P(t k+1 )=F(t k )·P(t k )·F(t k ) T +Q(t k ) (Formula 1)
[0130] Wherein, P(t) k+1 ) indicates that the first filter at t k+1 The state covariance matrix at time t; F(t) k F(t) represents the state transition matrix. k Q(t) can be calculated based on the following formula 2; k ) represents the noise covariance matrix, Q(t) k F(t) can be calculated based on the following formula 3; k ) T This represents the transpose of the state transition matrix.
[0131]
[0132] Where dt represents the time difference between adjacent epochs; I3 represents the identity matrix; τ d The relevant time for a Markov process is usually an empirical value.
[0133]
[0134] Where dt represents the time difference between adjacent epochs; PSD v The velocity system noise of the first filter is represented by PSD. v It can be calculated based on the variance of the historical velocity sequence and the time difference between adjacent epochs; PSD dtr The clock system noise of the first filter is represented by PSD. dtr It can be calculated based on the variance value corresponding to the historical clock difference sequence and the time difference between adjacent epochs; This represents the clock drift system noise of the first filter. It can be calculated based on the variance value corresponding to the historical clock drift sequence and the time difference between adjacent epochs. For example, the historical velocity sequence, historical clock difference sequence, and historical clock drift sequence can be determined from the historical positioning results corresponding to the mobile device through a time sliding window. For example, the historical positioning result information corresponding to the mobile device can refer to the positioning result obtained in the process of calculating the state parameters of the mobile device based on the first observation data.
[0135] For example, the process of updating the initial state parameters over time includes: at t k+1 At time t, the state parameters of the first filter are calculated based on Equation 4:
[0136] x(t k+1 )=F(t k )·x(t k ) (Formula 4)
[0137] Where x(t) k+1 ) indicates that the first filter at t k+1 State parameters at time t; x(t) k ) indicates that the first filter at t k State parameters at time t; F(t) k ) represents the state transition matrix.
[0138] Formula 4 can be used to implement the time update process of the initial state parameters of the first filter. Formulas 1 to 3 above can be used to implement the time update process of the initial state covariance matrix of the first filter. After the time update is completed, the state parameters of the first filter are called the first state parameters, and the state covariance matrix of the first filter is the first state covariance matrix.
[0139] Step 5012: In response to the first observation data satisfying the first screening condition, obtain the first observation residual matrix based on the first observation data and the first state parameter; determine the first measurement update matrix and the first measurement variance matrix corresponding to the first observation residual matrix.
[0140] The fact that the first observation data meets the first screening condition indicates that the first observation data has high reliability 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 necessary to first obtain the first observation residual matrix based on the first observation data and the first state parameters; and determine the first measurement update matrix and the 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 the matrices required for updating the first state parameters of the first filter based on the first observation data and the first state parameters.
[0141] For example, the first observation residual matrix is constructed based on the first observation data, the first state parameters, and the state information of the satellite to which the first observation data is applied (i.e., the first satellite). The first measurement update matrix is the Jacobian matrix of the first observation residual matrix with respect to the first state parameters, and the first measurement variance matrix is constructed based on the signal-to-noise ratio of the first observation data and the elevation angle of the satellite to which the first observation data is applied. The principles for obtaining the first observation residual matrix, the first measurement update matrix, and the first measurement variance matrix are... Figure 8 The principles for obtaining the initial observation residual matrix, initial Jacobian matrix, and initial measurement variance matrix in the illustrated embodiment are the same and will not be repeated here. Exemplarily, the first measurement variance matrix can also be based on the signal-to-noise ratio of the first observation data, the elevation angle of the satellite to which the first observation data is applied, and... Figure 8 The observation random error model factors (e.g., pseudorange observation random error model factors, Doppler observation random error model factors) obtained by solving the example shown are used to construct the model.
[0142] For example, when the first observation data includes first pseudorange observation data and 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.
[0143] In an exemplary embodiment, the process of determining whether the first observation data meets the first screening condition includes the following steps a and b.
[0144] Step a: Based on the first observation data, the first state parameters, and the first state covariance matrix, determine the model validation parameter values corresponding to the first filter.
[0145] Model validation parameter values can be used to determine whether the first filter system has a fault. In one possible implementation, the process of determining the 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 includes: determining the model validation parameter values 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 methods for obtaining the first observation residual matrix, the first measurement update matrix, the first measurement variance matrix, and the first state covariance matrix will be introduced later and will not be elaborated here.
[0146] For example, the first observation data includes at least one of first pseudorange observation data and first Doppler observation data. When the first observation data includes first pseudorange observation data, the first observation residual matrix includes the first pseudorange observation residual matrix, the first measurement update matrix includes the first pseudorange measurement update matrix, the first measurement variance matrix includes the first pseudorange measurement variance matrix, and the model validation parameter value corresponding to the first filter includes pseudorange model validation parameter values, which are 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. For example, the pseudorange model validation parameter values are calculated based on Formula 5:
[0147]
[0148] Where, β ρ represents the pseudorange model validation parameter values; P(t) represents the first-state covariance matrix; W represents the first pseudorange observation residual matrix; ρt G represents the variance matrix of the first pseudorange measurement; ρ Let represent the first pseudorange measurement update matrix, which is a Jacobian matrix. A Jacobian matrix is a matrix in which first-order partial derivatives are arranged in a certain way. This represents the transpose of the first pseudorange measurement update matrix.
[0149] When the first observation data includes first Doppler observation data, the first observation residual matrix includes the first Doppler observation residual matrix, the first measurement update matrix includes the first Doppler measurement update matrix, the first measurement variance matrix includes the first Doppler measurement variance matrix, and the model validation parameter value corresponding to the first filter includes Doppler model validation parameter values. These Doppler model validation parameter values are 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. For example, the Doppler model validation parameter values are calculated based on Formula 6:
[0150]
[0151] in, The values of the Doppler model validation parameters are represented; P(t) represents the first-state covariance matrix. This represents the residual matrix of the first Doppler observation; This represents the variance matrix of the first Doppler measurement; This represents the first Doppler measurement update matrix; This represents the transpose of the first Doppler measurement update matrix.
[0152] In an exemplary embodiment, the process of determining the 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 if it is determined that the first filter does not have any transitions. If the first filter has transitions, the transitions are repaired before subsequent operations are performed.
[0153] For example, the existence of a jump in the first filter may refer to at least one of clock bias jump and clock drift jump. In this case, before model verification of the first filter, clock bias detection and clock drift detection are performed. If a clock bias jump and / or clock drift jump is detected in the first filter, the clock bias jump and / or clock drift jump is repaired, that is, the first state parameters and the first state covariance parameters of the first filter are updated (which can also be called resetting the first filter); if no clock bias jump or clock drift jump is detected in the first filter, the first state parameters and the first state covariance matrix of the first filter remain unchanged.
[0154] In an exemplary embodiment, when the second pseudorange observation residual matrix satisfies the relationship shown in Formula 7 below, the first filter can be clock jump detected by sampling in the manner shown in Formula 8 below:
[0155]
[0156]
[0157] in, Represents the second pseudorange observation residual matrix The absolute median difference Represents the second pseudorange observation residual matrix The median of Represents the second pseudorange observation residual matrix standard deviation Represents the second pseudorange observation residual matrix The average value, θ m and θ clk Let P(t) be the clock error detection threshold. jclkjclk The j-th state covariance matrix represents the first state. clk Line jclk The elements of the column, jump clk This represents the clock bias jump value. This indicates the clock error detection value.
[0158] When jump clk A value of 0 indicates that the first filter has no clock bias jump; when jump... clk When the value is equal to 1, it indicates that there is a clock error jump in the first filter. The clock error jump can be repaired and the filter can be reset in the manner shown in Formula 9 below, that is, the first state parameters and the first state covariance matrix of the first filter are reset.
[0159]
[0160] Where, j clk This indicates the position of the clock error in the first state parameter x(t); In the first state parameter j clk The element at the specified position; Represents the j-th state in the first-state covariance matrix. clk The element in row t-th column; This represents the j-th row of the first-state covariance matrix. clk The elements of the column; the value of t ranges from 1 to h, where h (an integer not less than 1) represents the number of columns in the first-state covariance matrix; This represents the residual matrix of the second pseudorange observation; Represents the j-th state in the first-state covariance matrix. clk Line j clk The elements of the column; SQR(100.0) means taking the square root of 100.
[0161] Similar to the clock bias jump detection process described above, the residual matrix is observed using a second Doppler method. Clock drift detection and repair are performed. The principle of clock drift detection is the same as that of clock difference detection, so it will not be elaborated here.
[0162] When a clock drift transition is detected, the clock drift transition can be repaired and the filter reset in the manner shown in Formula 10 below, that is, the first state parameters and the first state covariance matrix of the first filter are reset.
[0163]
[0164] Where, j dclk This indicates the position of the clock drift in the first state parameter x(t); In the first state parameter j dclk The element at the specified position; Represents the j-th state in the first-state covariance matrix. dclkThe element in row t-th column; This represents the j-th row of the first-state covariance matrix. dclk Column elements; To represent the second Doppler observation residual matrix, for example, The residual matrix of Doppler observations is free of gross errors; Represents the second Doppler observation residual matrix the median; Represents the j-th state in the first-state covariance matrix. dclk Line j dclk The elements of the column. See Formula 9 for the meaning of other parameters.
[0165] Step b: In response to the model validation parameter value being less than the first threshold, obtain the test results of the observed sub-data in the first observation data. In response to the test results of the observed sub-data in the first observation data all meeting the retention conditions, determine that the first observation data meets the first screening conditions.
[0166] For example, when the model validation parameter values include pseudorange model validation parameter values and Doppler model validation parameter values, the first threshold includes both a pseudorange model validation parameter threshold and a Doppler model validation parameter threshold. A model validation parameter value less than the first threshold means that both the pseudorange model validation parameter value and the Doppler model validation parameter value are less than the first threshold. The pseudorange model validation parameter threshold and the Doppler model validation parameter threshold are set empirically or flexibly adjusted according to the application scenario; this embodiment does not limit this. The pseudorange model validation parameter threshold and the Doppler model validation parameter threshold can be the same or different.
[0167] In an exemplary embodiment, the pseudorange model verification parameter value may not be less than the pseudorange model verification parameter threshold. In this case, the first filter needs to be reset. Similarly, in an exemplary embodiment, the Doppler model verification parameter value may not be less than the Doppler model verification parameter threshold. In this case, the first filter also needs to be reset.
[0168] In one possible implementation, the process of obtaining the test results of the observed sub-data in the first observation data includes: standardizing 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 standardized residual matrix; testing the standardized residual matrix based on the second residual covariance matrix to obtain the test results corresponding to each element in the standardized residual matrix, wherein the second residual covariance matrix is constructed based on the first measurement update matrix, the first measurement variance matrix, and the first state covariance matrix, and any element in the standardized residual matrix is associated with an observed sub-data in the first observation data; and using the test results corresponding to each element in the standardized residual matrix as the test results of the corresponding observed sub-data in the first observation data, thus obtaining the test results of the observed sub-data in the first observation data.
[0169] For example, taking a first observation data set comprising first pseudorange observation data and first Doppler observation data, wherein the first pseudorange observation data comprises one or more pseudorange observation sub-data sets, and the first Doppler observation data comprises one or more Doppler observation sub-data sets. In this case, the standardized residual matrix comprises a standardized pseudorange residual matrix and a standardized Doppler residual matrix. Any element in the standardized pseudorange residual matrix is associated with a pseudorange observation sub-data set in the first pseudorange observation data set, and any element in the standardized Doppler residual matrix is associated with a Doppler observation sub-data set in the first Doppler observation data set. In this case, the test results corresponding to each element in the standardized pseudorange residual matrix are used as the test results for the corresponding pseudorange observation sub-data set in the first pseudorange observation data set, and the test results corresponding to each element in the standardized Doppler residual matrix are used as the test results for the corresponding Doppler observation sub-data set in the first Doppler observation data set.
[0170] For example, the normalized pseudorange residual matrix and the normalized Doppler residual matrix can be calculated based on Equation 11 and Equation 12, respectively:
[0171]
[0172]
[0173] Among them, v ρ Let represent the standardized pseudorange residual matrix; P(t) represents the first-state covariance matrix. W represents the first pseudorange observation residual matrix; ρt G represents the variance matrix of the first pseudorange measurement; ρ This represents the first pseudorange measurement update matrix; This represents the transpose of the first pseudorange measurement update matrix; Represents the normalized Doppler residual matrix; This represents the residual matrix of the first Doppler observation; This represents the variance matrix of the first Doppler measurement; This represents the first Doppler measurement update matrix; This represents the transpose of the first Doppler measurement update matrix.
[0174] The second residual covariance matrix includes the second pseudorange residual covariance matrix and the second Doppler residual covariance matrix. The process of testing the standardized residual matrix based on the second residual covariance matrix to obtain the test results corresponding to each element of the standardized residual matrix includes: testing the standardized pseudorange residual matrix based on the second pseudorange residual covariance matrix to obtain the test results corresponding to each element of the standardized pseudorange residual matrix; and testing the standardized Doppler residual matrix based on the second Doppler residual covariance matrix to obtain the test results corresponding to each element of the standardized Doppler residual matrix.
[0175] For example, the test result corresponding to the i-th element in the standardized pseudorange residual matrix (i.e., the test result corresponding to the i-th pseudorange sub-data in the first pseudorange observation data) is calculated based on Formula 13, and the test result corresponding to the i-th element in the standardized Doppler residual matrix (i.e., the test result corresponding to the i-th Doppler observation sub-data in the first Doppler observation data) is calculated based on Formula 14:
[0176]
[0177]
[0178] Among them, v ρ,i The normalized pseudorange residual matrix v ρ The i-th element in the dataset, where i is a positive integer less than or equal to the number of pseudorange observation sub-data points in the first pseudorange observation data, ω ρ,i The normalized pseudorange residual matrix v ρ The test result corresponding to the i-th element in the dataset; This represents the covariance matrix of the second pseudo-range residual; This represents the element in the i-th row and i-th column of the second pseudorange residual covariance matrix.
[0179] Represents the normalized Doppler residual matrix The i-th element in the dataset, where i is a positive integer less than or equal to the number of Doppler observation sub-data points in the first Doppler observation data. Represents the normalized Doppler residual matrix The test result corresponding to the i-th element in the dataset; Represents the second Doppler residual covariance matrix; This represents the element in the i-th row and i-th column of the second Doppler residual covariance matrix.
[0180] In an exemplary embodiment, the retention condition is met for the test result of any observation sub-data in the first observation data if the test result of that observation sub-data is not greater than the corresponding threshold. If the observation sub-data is any pseudorange observation sub-data, the retention condition is met for the test result of that observation sub-data if the test result of that pseudorange observation sub-data is not greater than the first test threshold; if the observation sub-data is any Doppler observation sub-data, the retention condition is met for the test result of that observation sub-data if the test result of that Doppler sub-data is not greater than the second test threshold. The first and second test thresholds are set empirically or flexibly adjusted according to the application scenario, and this embodiment does not limit them. The first and second test thresholds can be the same or different.
[0181] If the test results of each observation sub-data in the first observation data all meet the retention conditions, that is, the test results of each pseudorange observation sub-data in the first pseudorange observation data are not greater than the first test threshold, and the test results of each Doppler observation sub-data in the first Doppler observation data are not greater than the second test result, then the first observation data is determined to meet the first screening condition.
[0182] For example, if the test results of each observation sub-data in the first observation data do not uniformly meet the retention criteria, then the first observation data is determined not to meet the first screening criteria. Observation sub-data whose test results do not meet the retention criteria are removed to obtain the second observation data, and subsequent operations are then performed based on the second observation data. For example, the above process of removing observation sub-data whose test results do not meet the retention criteria can be regarded as a process of detecting gross errors in the first observation data based on the first observation residual matrix and the normal distribution test, and removing satellite data gross errors that cause the first filter to diverge from the first observation data.
[0183] It should be noted that the above-described method for determining whether the first observation data meets the first screening condition is merely illustrative, and the embodiments of this application are not limited thereto. For example, the first observation data may be determined to meet the first screening condition in response to the model validation parameter being less than a first threshold. Alternatively, the test results of the observation sub-data in the first observation data may be directly obtained, and the first observation data may be determined to meet the first screening condition in response to the test results of all observation sub-data in the first observation data meeting the retention condition.
[0184] Step 5013: Based on the first observation residual matrix, the first measurement update matrix, the first measurement variance matrix, and the first state covariance matrix, determine the first parameter increment, and use the sum of the first parameter increment and the first state parameter as the updated first state parameter of the first filter.
[0185] For example, the first parameter increment includes at least one of the first pseudorange state parameter increment and the first Doppler state parameter increment. This application embodiment illustrates an example where the first parameter increment includes both the first pseudorange parameter increment and the first Doppler parameter increment. In this case, the updated first state parameter includes both the updated first pseudorange state parameter and the updated first Doppler state parameter.
[0186] For example, the updated pseudorange state parameters are calculated based on the following formula 15:
[0187]
[0188] Where z1′(t) represents the updated first pseudorange state parameter; z1(t) represents the first pseudorange state parameter; P(t) represents the first state covariance matrix; G′ ρ R represents the first pseudorange measurement update matrix; ρ (t) represents the variance matrix of the first pseudorange measurement; This represents the residual matrix of the first pseudorange observation; This represents the increment of the first pseudorange parameter. K(t) can represent the pseudorange filter gain.
[0189] For example, the updated Doppler state parameters are calculated based on the following formula 16:
[0190]
[0191] Where z2′(t) represents the updated first Doppler state parameter; z2(t) represents the first Doppler state parameter; and P(t) represents the first state covariance matrix. This represents the first Doppler measurement update matrix; This represents the variance matrix of the first Doppler measurement; This represents the residual matrix of the first Doppler observation; This represents the increment of the first Doppler parameter. K′(t) can represent the Doppler filter gain.
[0192] Step 5014: In response to the updated first state parameter satisfying the first reference condition, obtain the first correction result based on the updated first state parameter.
[0193] The updated first state parameters include parameters whose types cover the types of parameters required for the positioning results of the mobile device. After obtaining the updated first state parameters, parameters whose types are the types of parameters required for the positioning results of the mobile device are extracted from the updated first state parameters to form the first correction result.
[0194] For example, the process of determining that the updated first state parameter satisfies the first reference condition includes: determining the covariance increment based on the first measurement update matrix, the first measurement variance matrix, and the first state covariance matrix; using the product of the covariance increment and the first state covariance matrix as the updated first state covariance matrix; performing a correction detection on the first parameter increment based on the updated first state covariance matrix; in response to the correction detection passing, verifying the first observation residual matrix based on the first residual covariance matrix to obtain the verification results corresponding to each element in the first observation residual matrix, wherein the 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 determining that the updated first state parameter satisfies the first reference condition if the verification results corresponding to each element in the first observation residual matrix all satisfy the verification condition.
[0195] For example, the covariance increment may include at least one of the pseudo-range covariance increment and the Doppler covariance increment. For example, if the covariance increment includes the pseudo-range covariance increment, the updated first-state covariance matrix can be calculated based on Equation 17:
[0196] P′(t)=(IK(t)G′ ρ )·P(t) (Formula 17)
[0197] Where P′(t) represents the updated first-state covariance matrix; P(t) represents the first-state covariance matrix; the meanings of other parameters are given in Formula 15.
[0198] For example, if the covariance increment includes the Doppler covariance increment, the updated first-state covariance matrix can be calculated based on Equation 18:
[0199] P′(t)=(IK′(t)G′ ρ )·P(t) (Formula 18)
[0200] Where P′(t) represents the updated first-state covariance matrix; P(t) represents the first-state covariance matrix; the meanings of other parameters are given in Formula 16.
[0201] For example, if the first parameter increment is the first pseudorange parameter increment, then the process of detecting the correction amount of the first parameter increment based on the updated first state covariance matrix includes: The value of is used as the metric corresponding to the i-th element in the first pseudorange parameter increment. If the metric corresponding to each element in the first pseudorange parameter increment is not greater than the first metric threshold, then the correction amount detection of the first pseudorange parameter increment is determined to be passed. Where dx iP′ represents the i-th element in the first pseudorange parameter increment dx. (t) ii This represents the element in the i-th row and i-th column of the updated first-state covariance matrix. According to Equation 15, the pseudorange parameter increment...
[0202] For example, if the first parameter increment is the Doppler parameter increment, the process of detecting the correction amount of the first parameter increment based on the updated first state covariance matrix includes: The value of is used as the measurement index corresponding to the i-th element in the first Doppler parameter increment. If the measurement index corresponding to each element in the first Doppler parameter increment is not greater than the second index threshold, then the correction amount detection of the first Doppler parameter increment is determined to be passed. Where d′x i P' represents the i-th element in the first Doppler parameter increment d′x. (t) ii This represents the element in the i-th row and i-th column of the updated first-state covariance matrix. According to Formula 16, the increment of the first Doppler parameter...
[0203] For example, if the correction amount detection of both the first pseudorange parameter increment and the first Doppler parameter increment passes, the correction amount detection is considered successful. If the detection of the first pseudorange parameter increment and / or the first Doppler parameter increment fails, the correction amount detection is considered unsuccessful, and in this case, the first filter needs to be reset.
[0204] After confirming that the correction has passed the test, 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. The first observation residual matrix is then tested based on the first residual covariance matrix to obtain the test results corresponding to each element in the first observation residual matrix.
[0205] For example, the first residual covariance matrix includes a first pseudorange residual covariance matrix and a first Doppler residual covariance matrix; the first observation residual matrix includes a first pseudorange observation residual matrix and a first Doppler observation parameter matrix. For example, the first observation residual matrix can be referred to as the posterior observation residual matrix.
[0206] For example, the test result of the i-th element in the first pseudorange observation residual matrix is calculated based on Equation 19:
[0207]
[0208] Where, μ i G′ represents the test result of the i-th element in the first pseudorange observation residual matrix; ρ R represents the first pseudorange measurement update matrix;ρ P(t) represents the first pseudorange measurement variance matrix; P′(t) represents the updated first state covariance matrix; This represents the i-th element in the first pseudorange observation residual matrix, where i is an integer less than or equal to the number of elements in the first pseudorange observation residual matrix. This represents the covariance matrix of the first pseudo-range residual; This represents the element in the i-th row and i-th column of the first pseudorange residual covariance matrix.
[0209] For example, the test result of the i-th element in the first Doppler observation residual matrix is calculated based on Equation 20:
[0210]
[0211] Where, α i This represents the test result of the i-th element in the first Doppler observation residual matrix; This represents the first Doppler measurement update matrix; Let P'(t) represent the variance matrix of the first Doppler measurement; P'(t) represent the updated first-state covariance matrix. This represents the i-th element in the first Doppler observation residual matrix, where i is an integer less than or equal to the number of elements in the first Doppler observation residual matrix. Represents the first Doppler residual covariance matrix; This represents the element in the i-th row and i-th column of the first Doppler residual covariance matrix.
[0212] For example, for a test result corresponding to a certain element to satisfy the test condition, it means that the test result of that element is less than the corresponding threshold. For example, for the test results corresponding to each element in the first observation residual matrix to satisfy the test condition, it means that the test results corresponding to each element in the first pseudorange observation residual matrix are all less than the first target threshold, and the test results corresponding to each element in the first Doppler observation residual matrix are all less than the second target threshold. The first target threshold and the second target threshold are set empirically or flexibly adjusted according to the application scenario. The first target threshold and the second target threshold can be the same or different.
[0213] When it is determined that the test results corresponding to each element in the first observation residual matrix all meet the test conditions, the updated first state parameters are determined to meet the first reference conditions.
[0214] In an exemplary embodiment, if the test result corresponding to a certain element does not meet the test condition, it is determined that the updated first state parameter does not meet the first reference condition. The observation sub-data associated with the element can be removed from the first observation data to obtain filtered observation data, and then subsequent operations can be performed based on the filtered observation data.
[0215] It should be noted that the above-described method for determining whether the updated first state parameter meets the first reference condition is merely an illustrative example, and the embodiments of this application are not limited thereto. In some embodiments, the updated first state parameter may also be considered to meet the first reference condition when the correction amount detection passes. In some embodiments, the correction amount detection may be omitted, and only the test results corresponding to each element in the first observation residual matrix may be obtained. When the test results corresponding to each element in the first observation residual matrix all meet the test conditions, the updated first state parameter is determined to meet the first reference condition.
[0216] For example, the correlation processing of the first filter can be found in [reference needed]. Figure 6 The process involves initializing the first filter, updating its time, and then updating its measurement. During the measurement update, clock error and clock drift are detected and corrected. Then, outlier detection is performed based on a normal distribution test. Finally, the first filter is validated and corrected using observational data after removing outliers. After model validation and correction, the updated solution for the first filter is validated and corrected through correction amount detection and post-hoc observation residual matrix verification.
[0217] In step 502, the first correction result is corrected using double-difference observation data to obtain the second correction result, which is then used as the target positioning result.
[0218] The second correction result is obtained by correcting the first correction result using double-difference observation data. The second correction result is more reliable than the first correction result. After obtaining the second correction result, using it as the target positioning result of the mobile device helps to ensure the reliability of the target positioning result, improve the positioning accuracy and robustness.
[0219] In one possible implementation, the process of correcting the first correction result using double-difference observation data to obtain the second correction result can be implemented using a second filter. See also Figure 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.
[0220] Step 5021: Determine the second state parameters of the second filter based on the first correction result, and obtain the second state covariance matrix corresponding to the second state parameters.
[0221] The second filter is the filter on which the first correction result is corrected using double-difference observation data. The type of the second filter may include, but is not limited to, Kalman filter, extended Kalman filter, unscented Kalman filter, robust Kalman filter, etc. The embodiments of this application do not limit this.
[0222] The second state parameter refers to the state parameters of the second filter that need to be updated. For example, the type of parameters in the state parameters of the second filter includes the type of parameters in the positioning results of the mobile device, such as location type. For example, the double-difference observation data includes carrier phase observation data, and the type of parameters in the state parameters of the second filter also includes integer ambiguity type. Integer ambiguity, also known as integer unknown, is the integer unknown corresponding to the first observation value of the phase difference between the carrier phase and the reference phase during carrier phase measurement in Global Positioning System (GPS) technology.
[0223] In an exemplary embodiment, the method for obtaining the second state parameter of the second filter based on the first correction result can be: using the state parameter including the position of the first positioning result and the initial value of the integer ambiguity as the second state parameter. In an exemplary embodiment, the method for obtaining the second state parameter of the second filter based on the first correction result can also be: using the state parameter including the position of the first positioning result and the initial value of the integer ambiguity as the second initial state parameter, and updating the second initial state parameter over time to obtain the second state parameter.
[0224] The second-state covariance matrix can be used to characterize the correlation between second-state parameters. This second-state covariance matrix is a diagonal matrix and is also a symmetric matrix. For example, when the state parameters including the position of the first positioning result and the initial integer ambiguity value are used as the second-state parameters, the second-state covariance matrix can be set empirically. For example, when the state parameters including the position of the first positioning result and the initial integer ambiguity value are used as the second initial-state parameters, and the second initial-state parameters are updated over time to obtain the second-state parameters, the method for obtaining the first-state covariance matrix corresponding to the first-state parameters can be: obtaining the second initial-state covariance matrix corresponding to the second initial-state parameters, updating the second initial-state covariance matrix over time, and using the covariance matrix obtained after the time update as the second-state covariance matrix corresponding to the second-state parameters.
[0225] Step 5022: In response to the double-difference observation data satisfying the second screening condition, obtain the double-difference observation residual matrix based on the double-difference observation data and the second state parameter; determine the double-difference measurement update matrix and the double-difference measurement variance matrix corresponding to the double-difference observation residual matrix.
[0226] The fact that double-difference observation data meets the second screening criterion indicates that the double-difference observation data has high reliability and can be directly used to update the second state parameters. In the process of updating the second state parameters using double-difference observation data, it is necessary to first obtain the double-difference observation residual matrix based on the double-difference observation data and the second state parameters; and then determine the corresponding double-difference measurement update matrix and double-difference measurement variance matrix. The double-difference measurement variance matrix, double-difference measurement update matrix, and double-difference observation residual matrix are the matrices required for updating the second state parameters of the second filter, determined based on the double-difference observation data and the second state parameters.
[0227] In one possible implementation, the process of obtaining the double-difference observation residual matrix based on double-difference observation data and a second state parameter includes: obtaining double-difference estimation data based on the second state parameter; and constructing the double-difference observation residual matrix based on the double-difference observation data and the double-difference estimation data.
[0228] 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.
[0229] For example, the pseudorange double-difference estimation data includes pseudorange double-difference estimates for each of the other satellites in the first satellite group, excluding the reference satellite, and the carrier phase double-difference estimation data includes carrier phase double-difference estimates for each of the other satellites. Both the pseudorange double-difference estimate for any other satellite and the carrier phase double-difference estimate for any other satellite are obtained based on the difference between the first range difference and the second range difference for that other satellite.
[0230] The first distance difference corresponding to any other satellite refers to the difference between the geometric distance between the reference satellite and the mobile device and the geometric distance between the reference satellite and the mobile device. The second distance difference corresponding to any other satellite refers to the difference between the geometric distance between the reference satellite and the base station and the geometric distance between the reference satellite and the base station. The geometric distance between the satellite and the mobile device can be calculated based on the position in the satellite's state information and the position in the second state parameter; the geometric distance between the satellite and the base station can be calculated based on the position in the satellite's state information and the position of the base station.
[0231] After acquiring double-difference observation data and double-difference estimation data, a double-difference observation residual matrix is constructed based on the double-difference observation data and double-difference estimation data. For example, 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 the double-difference observation residual matrix based on the double-difference observation data and double-difference estimation data includes: constructing a pseudorange double-difference observation residual matrix based on the pseudorange double-difference observation data and pseudorange double-difference estimation data; constructing a carrier phase double-difference observation residual matrix based on the pseudorange double-difference estimation data and carrier phase double-difference estimation data; and using the matrix formed by the pseudorange double-difference observation residual matrix and the carrier phase double-difference observation residual matrix as the double-difference observation residual matrix.
[0232] For example, the formulas for constructing the pseudorange double-difference observation residual matrix and the carrier phase double-difference observation residual matrix are shown in Formula 21 and Formula 22, respectively:
[0233]
[0234]
[0235] Among them, z ρ Represents the pseudorange double-difference residual matrix. Represents the carrier phase double-difference residual matrix. Let represent the geometric distance between the first satellite i (i = 1, 2, ..., n) and the mobile device, where n (an integer not less than 2) is the number of the first satellites. This represents the geometric distance between the first satellite i and the base station; the first satellite 1 is the reference satellite. This represents the pseudorange double-difference observation value corresponding to the first satellite. This represents the carrier phase double difference observation value corresponding to the first satellite 2, and so on. Indicates double-difference ionospheric delay. Indicates double-difference tropospheric delay. This represents integer ambiguity, which is an integer. The double-difference ionospheric delay and the double-parameter tropospheric delay can be set empirically, and this embodiment does not impose any limitations on them. When constructing the double-difference observation residual matrix, the integer ambiguity can be initialized empirically.
[0236] After obtaining the pseudorange double-difference observation residual matrix and the carrier phase double-difference observation residual matrix, 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.
[0237] After obtaining the double-difference observation residual matrix, the corresponding double-difference measurement update matrix and double-difference measurement variance matrix are determined. For example, the double-difference measurement variance matrix can be constructed empirically, or it can be constructed based on the signal-to-noise ratio of the double-difference observation data and the state information of the satellite to which the double-difference observation data is applied. For example, the double-difference measurement update matrix can be the coefficients in the difference constraint equation, which is constructed based on the double-difference observation residual matrix. For example, the difference constraint equation is the double-difference observation residual matrix. The difference constraint equation between the variable and the preset increment matrix δx. Exemplarily, the difference constraint equation can also be called the Kalman correction equation, the RTK difference constraint correction equation, etc. Exemplarily, the difference constraint equation is shown in Equation 23:
[0238]
[0239] Where H represents the coefficients of the difference constraint equation (i.e., the double-difference measurement update matrix), and H is the Jacobian matrix of the double-difference observation residual matrix with respect to the second state parameter. For example, the expression for H is shown in Equation 24:
[0240]
[0241] in, λ represents the unit observation vector from the mobile device to the first satellite s (s = 1, 2, ..., n), and λ represents the carrier wavelength.
[0242] In an exemplary embodiment, the method for determining whether double-difference observation data meets the second screening condition can be: performing gross error detection on the double-difference observation residual matrix; if the detection result indicates that there is no data in the double-difference observation data that needs to be removed, then the double-difference observation data is determined to meet the second screening condition. For example, the method for performing gross error detection on the double-difference observation residual matrix can be based on quartiles, or it can be based on the absolute median, etc., and this embodiment does not limit this approach.
[0243] Step 5023: Based on the double-difference observation residual matrix, double-difference measurement update matrix, double-difference measurement variance matrix, and second state covariance matrix, determine the second parameter increment, and use the sum of the second parameter increment and the second state parameter as the updated second state parameter of the second filter.
[0244] The second parameter increment is the increment used to update the second state parameter. For example, the process of determining the 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 is implemented based on Equation 25:
[0245]
[0246] in, Indicates the increment of the second parameter; P - (t k ) represents the second-state covariance matrix, which is used to represent the relationship between the parameters in the second-state parameters, and can be set according to experience; R represents the Kalman gain; RTK (t k ) represents the variance matrix of the double-difference measurement; H represents the update matrix of the double-difference measurement. This represents the double-difference observation residual matrix.
[0247] In an exemplary embodiment, the second state covariance matrix can be updated based on the Kalman gain and the double-difference measurement update matrix, as shown in Equation 26:
[0248]
[0249] Among them, P + (t k ) represents the updated second-state covariance matrix. For the meaning of other parameters, please refer to Formula 25.
[0250] In an exemplary embodiment, the process of determining whether the modified parameter matrix satisfies the specified conditions can be as follows: if the modified parameter matrix converges, then the modified parameter matrix is determined to satisfy the specified conditions.
[0251] Step 5024: In response to the updated second state parameter satisfying the second reference condition, obtain the second correction result based on the updated second state parameter.
[0252] In an exemplary embodiment, the process of determining whether the updated second state parameter satisfies the second reference condition can further include: performing a correction quantity test on the post-difference double-difference observation residual matrix; if the correction quantity test passes, performing a normal distribution test on the post-difference pseudorange double-difference observation residual matrix and the post-difference carrier phase double-difference observation residual matrix, respectively. When both the post-difference pseudorange double-difference observation residual matrix and the post-difference carrier phase double-difference observation residual matrix pass the normal distribution test, it is determined that the updated second state parameter satisfies the second reference condition. For example, if the post-difference pseudorange double-difference observation residual matrix and / or the post-difference carrier phase double-difference observation residual matrix fail the normal distribution test, it is determined that the updated second state parameter does not satisfy the second reference condition, and data associated with pseudorange observations and / or carrier phase observations that failed the normal distribution test need to be removed from the double-difference observation data.
[0253] For example, the post-hoc double-difference observation residual matrix is the double-difference observation residual matrix obtained based on the updated second state parameters and double-difference observation data. The pseudorange double-difference observation residual matrix included in the post-hoc double-difference observation residual matrix is called the post-hoc pseudorange double-difference observation residual matrix, and the carrier phase double-difference observation residual matrix included in the post-hoc double-difference observation residual matrix is called the post-hoc carrier phase double-difference observation residual matrix.
[0254] In an exemplary embodiment, obtaining the second correction result based on the updated second state parameters includes: extracting parameters of the type required for the positioning result of a mobile device from the updated second state parameters to form the second correction result. For example, extracting location type parameters from the updated second state parameters to form the second correction result.
[0255] In an exemplary embodiment, the updated second state parameter includes a floating-point solution for the position and a floating-point solution for the integer ambiguity. The floating-point solution has poor precision. In this case, obtaining a second correction result based on the updated second state parameter includes: fixing the floating-point solution for the integer ambiguity; in response to successful fixing, calculating a fixed solution for the position using the fixed solution for the integer ambiguity, and using the result including the fixed solution for the position as the second correction result; in response to unsuccessful fixing, using the result including the floating-point solution for the position as the second correction result.
[0256] For example, fixing the floating-point solution of integer ambiguity can be achieved using MLAMBDA (an improved least mean square ambiguity decorrelation adjustment algorithm). Specifically, fixing the floating-point solution of integer ambiguity based on MLAMBDA can be achieved using carrier phase double-difference parameter values and carrier phase double-difference covariance matrix. These carrier phase double-difference parameter values and carrier phase double-difference covariance matrix can be extracted from the state parameters and state covariance matrix of the second filter. If the fixing is successful, the positions included in the second correction result are the fixed solutions calculated based on the fixed integer ambiguity, resulting in high accuracy.
[0257] This positioning method, after obtaining the initial positioning result, first corrects the result using the initial observation data, and then further corrects the result using double-difference observation data to obtain the target positioning result. The process of obtaining the target positioning result comprehensively considers point cloud data, initial observation data, and double-difference observation data, providing richer information and resulting in higher accuracy. This positioning method has low dependence on any single type of data, which helps improve the robustness of the positioning.
[0258] This application also provides an implementation process for obtaining a target positioning result based on a first positioning result using target data. This implementation process is another specific implementation process when the target data includes first observation data and double-difference observation data. Taking the application of this method to a mobile device 110 as an example... Figure 7 As shown, the method provided in this application embodiment may include the following steps 701 to 703.
[0259] In step 701, the mobile device is located using the first observation data to obtain a second location result.
[0260] In an exemplary embodiment, point cloud data is not required to be considered during the process of locating the mobile device using the first observation data. That is, step 701 can be executed independently of the process of locating the mobile device using point cloud data and obtaining the first positioning result. This application embodiment does not limit the execution order of step 701 and the process of locating the mobile device using point cloud data and obtaining the first positioning result.
[0261] For example, the process of locating a mobile device using the first observation data can be implemented based on the first filter. The principle of locating a mobile device using the first observation data based on the first filter is the same as the principle of correcting the first positioning result using the first observation data based on the first filter. The difference is that in the process of correcting the first positioning result using the first observation data based on the first filter, the first state parameter of the first filter is determined based on the first positioning result. However, in the process of locating a mobile device using the first observation data based on the first filter, the first state parameter of the first filter is obtained through initialization, and this initialization process does not consider the first positioning result.
[0262] For example, in the process of locating a mobile device using the first observation data based on the first filter, the methods for initializing and obtaining the first state parameters of the first filter include, but are not limited to: setting the first state parameters of the first filter based on experience; determining the first state parameters of the first filter based on historical positioning results; calculating the state parameters of the mobile device based on the first observation data, and determining the first state parameters of the first filter based on the calculated state parameters. For details on the process of calculating the state parameters of the mobile device based on the first observation data, see [link to documentation]. Figure 8 The embodiments shown are not described in detail here.
[0263] In an exemplary embodiment, the process of locating a mobile device using the first observation data may also be implemented without relying on the first filter. For example, the state parameters of the mobile device are calculated based on the first observation data, and the result including the calculated state parameters is used as the second positioning result.
[0264] In other words, the second positioning result can be obtained based on the calculated state parameters. For example, the result including the calculated state parameters can be used as the second positioning result; or, the first state parameters of the first filter can be determined based on the calculated state parameters, and the second positioning result can be obtained through filtering by the first filter. The calculated state parameters have high accuracy, and obtaining the second positioning result based on the calculated state parameters is beneficial to improving the positioning accuracy of the second positioning result.
[0265] For example, the process of determining the first state parameters of the first filter based on the calculated state parameters and obtaining the second positioning result through filtering by the first filter includes: determining the first state parameters of the first filter based on the calculated state parameters, and obtaining the first state covariance matrix corresponding to the first state parameters; in response to the first observation data satisfying the first screening condition, obtaining the first observation residual matrix based on the first observation data and the first state parameters; determining the first measurement update matrix and the first measurement variance matrix corresponding to the first observation residual matrix; determining the 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 using the sum of the first parameter increment and the first state parameters as the updated first state parameters of the first filter; in response to the updated first state parameters satisfying the first reference condition, obtaining the first positioning result based on the updated first state parameters. The implementation principle of this process is similar to... Figure 5 Step 501 in the illustrated embodiment is the same and will not be repeated here.
[0266] In step 702, the mobile device is located using double-difference observation data to obtain a third positioning result.
[0267] In an exemplary embodiment, point cloud data is not required during the process of locating the mobile device using the first observation data. That is, step 702 can be executed independently of the process of locating the mobile device using point cloud data and obtaining the first location result. This application embodiment does not limit the execution order of step 702 and the process of locating the mobile device using point cloud data and obtaining the first location result. In addition, step 702 can also be executed independently of step 701.
[0268] For example, the process of locating a mobile device using double-difference observation data can be implemented using a second filter. The principle of locating a mobile device using double-difference observation data using a second filter is the same as the principle of correcting the first correction result using double-difference observation data using a second filter. The difference is that in the process of correcting the first correction result using double-difference observation data using a second filter, the second state parameter of the second filter is determined based on the first correction result. However, in the process of locating a mobile device using double-difference observation data using a second filter, the second state parameter of the second filter is obtained through initialization, and this initialization process does not consider the first positioning result.
[0269] For example, in the process of locating a mobile device using double-difference observation data based on the second filter, the methods for initializing the second state parameters of the second filter include, but are not limited to: setting the second state parameters of the second filter based on experience; determining the second state parameters of the second filter based on historical positioning results; calculating the state parameters of the mobile device based on the first observation data, and determining the second state parameters of the second filter based on the calculated state parameters.
[0270] In step 703, the first positioning result, the second positioning result, and the third positioning result are fused, and the fused result is used as the target positioning result.
[0271] The first, second, and third positioning results are all predictions of the mobile device's positioning at the current positioning time. By fusing the first, second, and third positioning results, a target positioning result can be obtained by comprehensively considering point cloud data, first observation data, and double-difference observation data. This target positioning result has a low dependence on any one type of data, which is beneficial to improving the accuracy and robustness of the target positioning result.
[0272] For example, the first, second, and third positioning results all include parameters of the same type to facilitate fusion. For instance, the first, second, and third positioning results all include position, or the first, second, and third positioning results all include both position and velocity.
[0273] In one possible implementation, the process of fusing the first, second, and third positioning results and using the fused 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, second, and third positioning results based on the first, second, and third weights, and using the fused result as the target positioning result of the mobile device. The first, second, and third weights are set empirically or flexibly adjusted according to the application scenario, and this application embodiment does not limit this. For example, for a positioning result obtained based on a filter, the weight corresponding to the positioning result can be determined based on the state covariance matrix on which the positioning result was obtained.
[0274] In another possible implementation, the process of fusing the first positioning result, the second positioning result, and the third positioning result and using the fused result as the target positioning result of the mobile device may also include: fusing any two of the first positioning result, the second positioning result, and the third positioning result to obtain a fused result; fusing the fused result with the unfused positioning results and using the fused result as the target positioning result of the mobile device.
[0275] For example, the process of fusing two positioning results can be implemented based on the weights corresponding to the two positioning results respectively. The weights corresponding to the two positioning results can be set according to experience or flexibly adjusted according to the application scenario. This application embodiment does not limit this.
[0276] This positioning method uses point cloud data, first observation data, and double-difference observation data to locate the mobile device. After obtaining the three positioning results, they are fused to obtain the target positioning result. The process of obtaining the target positioning result comprehensively considers point cloud data, first observation data, and double-difference observation data, taking into account richer information and resulting in higher accuracy. This positioning method has low dependence on any one type of data, which helps to improve the robustness of positioning.
[0277] In an exemplary embodiment, such as Figure 8 As shown, the process of calculating the state parameters of the mobile device based on the first observation data includes the following steps 801 to 803.
[0278] In step 801, the initial observation residual matrix is obtained based on the first observation data and the initial positioning results; the initial Jacobian matrix and the initial measurement variance matrix corresponding to the initial observation residual matrix are determined.
[0279] For example, 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 the Jacobian matrix of the initial observation residual matrix with respect to the initial positioning result. The initial measurement variance matrix is constructed based on the signal-to-noise ratio of the first observation data and the elevation angle of the first satellite. For example, the initial Jacobian matrix can also be called the initial measurement update matrix.
[0280] The state information of the first satellite includes at least one of its position, clock bias, velocity, and clock drift. This state information can be obtained by the mobile device based on first observation data and the navigation ephemeris of the first satellite. The initial positioning result can be randomly set based on experience. For example, the initial positioning result includes at least one of initial pseudorange positioning result and 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.
[0281] If the initial positioning result includes the initial pseudorange positioning result, then the first observation data includes the first pseudorange observation data, which includes the pseudorange observation sub-data corresponding to the first satellite. The state information of the first satellite includes the pseudorange state information of the first satellite (i.e., the position and clock bias of the first satellite). If the initial positioning result includes the initial Doppler positioning result, then the first observation data includes the first Doppler observation data, which includes the Doppler observation sub-data corresponding to the first satellite. The state information of the first satellite includes the Doppler state information of the first satellite (i.e., the velocity and clock drift of the first satellite).
[0282] For example, if the initial positioning result includes the initial pseudorange positioning result and the initial Doppler positioning result, then the process of solving the state parameters of the mobile device based on the first observation data depends on the pseudorange observation equation and the Doppler observation equation.
[0283] Taking the number of satellites in the first phase as n as an example, the pseudorange observation equation is the equation shown in Formula 27:
[0284]
[0285] in, r represents the pseudorange observation sub-data corresponding to the first satellite i (i = 1, 2, ..., n) received by the mobile device. u Indicates the location of the mobile device, r i dt represents the position of the first satellite i. r dt represents the clock skew (or clock bias) of a mobile device. i Let c represent the clock difference of the first satellite i, and c be the speed of light in a vacuum. ζ iThis represents the error correction number corresponding to the first satellite i (including ionospheric, tropospheric, and Earth rotation corrections, which can be calculated from an empirical model); ||r u -r i || represents the location r of the mobile device u Position r of the first satellite i i The Euclidean distance (geometric distance) between them. In Equation 27, except for the position r of the mobile device. u Clock difference dt between mobile devices r All other parameters are known, and the position and clock error of the mobile device can be estimated based on the pseudorange observation equation shown in Equation 27.
[0286] Taking the number of satellites in the first phase as n as an example, the Doppler observation equation is shown in Equation 28:
[0287]
[0288] Where λ represents the wavelength of the satellite broadcast signal. v represents the Doppler observation sub-data corresponding to the first satellite i (i = 1, 2, ..., n) received by the mobile device. i v represents the velocity of the first satellite i. u Indicates the speed of the mobile device. This indicates clock drift on mobile devices. The value represents the clock drift of the first satellite i. The meanings of the other parameters are explained in Equation 27. The velocity and clock drift of the mobile device can be estimated based on the Doppler observation equation shown in Equation 28. Solving for the velocity and clock drift of the mobile device requires providing the position of the mobile device and the positions of each of the first satellites. For example, the pseudorange observation equation shown in Equation 27 and the Doppler observation equation shown in Equation 28 can be collectively referred to as the satellite observation equations.
[0289] For example, using the pseudorange observation equation, it is possible to estimate the position and clock bias of the mobile device. For example, the position and clock bias of the mobile device are then used with estimated parameters. This indicates that the purpose of estimating the location and clock bias of the mobile device is to iteratively update the estimated parameter x. u This allows for the estimation of the mobile device's position and clock drift. Using the Doppler observation equation, the mobile device's velocity and clock drift can be estimated. For example, the mobile device's velocity and clock drift are estimated using the following parameters: This indicates that the purpose of estimating the speed of mobile devices and clock drift is to iteratively update the aforementioned estimated parameters y. u To obtain estimates of the speed of mobile devices and clock drift.
[0290] For example, the method for calculating the state parameters of a mobile device provided in this application embodiment can be called robust weighted least squares. Robust weighted least squares organically combines the robust estimation principle with the least squares form through equivalent weights. The main components of the measured values generally conform to a normal distribution. Least squares (also known as the least squares method) is a mathematical optimization method. It should be noted that this robust weighted least squares method is merely an example provided in this application embodiment. Other mathematical optimization methods besides robust weighted least squares are also applicable, such as Newton's method and stochastic gradient descent. This application embodiment does not limit these methods.
[0291] In estimating the location and clock bias of a mobile device using robust weighted least squares, the estimation parameter x is first set. u The initial values, i.e., the initial position and initial clock difference for the mobile device, are denoted as . In estimating the speed and clock drift of a mobile device using robust weighted least squares, the estimation parameter y is first set. u The initial values, i.e., the initial velocity and initial clock drift of the mobile device, are denoted as
[0292] If the initial positioning result includes the initial pseudorange positioning result (i.e., the initial position and initial clock bias of the mobile device), then the first observation data includes the first pseudorange observation data (i.e., the pseudorange observation sub-data corresponding to the 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 the initial pseudorange observation residual matrix. If the initial positioning result includes the initial Doppler positioning result (i.e., the initial velocity and initial clock drift of the mobile device), then the first observation data includes the first Doppler observation data (i.e., the Doppler observation sub-data corresponding to the 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 the initial Doppler observation residual matrix.
[0293] The initial pseudorange observation residual matrix is obtained based on the initial position and 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; the initial Doppler observation residual matrix is obtained based on the initial velocity and 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.
[0294] For example, the geometric distance between the initial position and the position of the first satellite i is obtained, such as ||r|| u,0 -r i ‖, and obtain the clock difference between the initial clock difference and the clock difference of the first satellite i, such as dt r,0 -dt iBased on the geometric distance and clock difference, a first estimated value between the mobile device and the first satellite i can be determined, such as ||r||. u,0 -r i ‖+c·dt r,0 -c·dt i +ζ i By using the first estimated value and the pseudorange observation sub-data corresponding to the first satellite i, a pseudorange observation equation between the mobile device and the first satellite is constructed. The form of this pseudorange observation equation is shown in Formula 27 above, except that r in Formula 27 is changed. u Replace with r u,0 dt r Replace with dt r,0 Furthermore, by subtracting both sides of the pseudorange observation equation, we can obtain the initial pseudorange observation residual matrix. The elements in the initial pseudorange observation residual matrix can be represented as the residual values between the pseudorange observation sub-data corresponding to each first satellite and the estimated values obtained from the initial position, the position of the first satellite, the initial clock error, and the clock error of the first satellite.
[0295] For example, the velocity difference between the initial velocity and the velocity of the first satellite i is obtained, and the unit observation value between the mobile device and the first satellite i is obtained, such as... Obtain the clock drift difference between the initial clock drift and the clock drift of the first satellite i; based on the product of the velocity difference and the unit observation value, and the clock drift difference, determine the second estimated value between the mobile device and the first satellite i, such as... A Doppler observation equation between the mobile device and the first satellite is constructed by multiplying the wavelength of the satellite broadcast signal and the corresponding Doppler observation sub-data from the first satellite, along with a second estimate. This Doppler observation equation takes the form of Equation 28 above, except that v in Equation 28 is changed... u Replace with v u,0 , Replace with r u Replace with r u,0 Furthermore, by subtracting both sides of the Doppler observation equation, the Doppler observation residual matrix can be obtained.
[0296] After constructing the initial observation residual matrix, the Jacobian matrix of the initial observation residual matrix with respect to the initial positioning result is used as the initial Jacobian matrix. The initial measurement variance matrix is constructed based on the signal-to-noise ratio of the first observation data and the elevation angle of the first satellite.
[0297] For example, if the initial observation residual matrix includes the initial pseudorange observation residual matrix, then the initial Jacobian matrix includes the initial pseudorange Jacobian matrix, and the initial measurement variance matrix includes the initial pseudorange measurement variance matrix. The initial pseudorange Jacobian matrix refers to the Jacobian matrix of the initial pseudorange observation residual matrix with respect to the initial pseudorange positioning result; 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 elevation angle of the first satellite.
[0298] For example, suppose the estimated parameters for the k-th (k is an integer) iteration are... When k is 0, the estimated parameters for the k-th iteration include the initial position and the initial clock error. The satellite observation equation for each iteration is constructed from the estimated parameters of that iteration. That is, the pseudorange observation equation for the k-th iteration needs to replace the position and clock error of the mobile device in Equation 27 above with x. uk Position r in u,k and clock difference dt r,k The partial derivatives of the pseudorange observation equation in the k-th iteration with respect to the estimated parameters in the k-th iteration are used to determine the pseudorange Jacobian matrix in the k-th iteration. The pseudorange Jacobian matrix in the k-th iteration is denoted as G. ρk The Jacobian matrix G ρk It can be shown in the following formula 29:
[0299]
[0300] in, This represents the unit observation vector from the mobile device to satellite i (i = 1, 2, ..., n) at the k-th iteration. It should be noted that the initial pseudorange Jacobian matrix refers to the pseudorange Jacobian matrix when k = 0, i.e., G. ρ0 .
[0301] For example, based on the signal-to-noise ratio of the pseudorange observation sub-data corresponding to each of the n first satellites and the elevation angle corresponding to each of the n first satellites, the pseudorange observation error corresponding to each of the n first satellites is determined; the pseudorange observation error corresponding to each of the n first satellites is used as the diagonal element of the matrix to construct the initial pseudorange measurement variance matrix.
[0302] For example, taking the number of pseudorange observation sub-data (i.e., the number of the first satellite) as n, the pseudorange measurement variance matrix can be shown in the following formula 30:
[0303]
[0304] Among them, W ρk Let σ represent the pseudorange measurement variance matrix of the k-th iteration. ρi σ represents the pseudorange observation error corresponding to the first satellite i. ρi It can be calculated based on the following formula 31:
[0305]
[0306] Among them, CN0 i el represents the signal-to-noise ratio corresponding to the pseudorange observation sub-data of the first satellite i. i δ represents the elevation angle of the first satellite i; ρ This represents the pseudorange observation error parameter, which can be set empirically or adjusted flexibly according to actual conditions. This application's embodiments do not impose such limitations. For example, δ ρ It can be set to 3 2 .
[0307] For example, the pseudorange measurement variance matrix is a matrix with fixed values in the estimation of parameter x. u During the iterative update process, if the pseudorange observation data used remains unchanged, the pseudorange measurement variance matrix remains unchanged. That is, the pseudorange measurement variance matrix of the k-th iteration is the same as the pseudorange measurement variance matrix of the 0th iteration (the initial pseudorange measurement variance matrix), i.e., the aforementioned W... ρk This is the initial pseudorange measurement variance matrix.
[0308] For example, the process of obtaining the initial pseudorange Jacobian matrix of the initial pseudorange observation residual matrix with respect to the initial pseudorange positioning result is performed after determining that the initial pseudorange observation residual matrix satisfies the gross error filtering condition, thereby improving the reliability of the positioning result solution process. The fact that the initial pseudorange observation residual matrix satisfies the gross error filtering condition indicates that the reliability of the pseudorange observation sub-data corresponding to the initial pseudorange observation residual matrix is relatively high. For example, the process of determining whether the initial pseudorange observation residual matrix satisfies the gross error filtering condition includes: performing gross error detection on the initial pseudorange observation residual matrix based on quartiles; if there are no pseudorange observation sub-data that need to be removed, then it is determined that the initial pseudorange observation residual matrix satisfies the gross error filtering condition.
[0309] For example, the process of gross error detection based on the quartile initial pseudorange observation residual matrix can be derived into many different schemes in specific implementation. For example, for the same data, different gross error detection conditions may result in different results, and the gross error detection schemes that cause different results should be different. This application takes a quartile-based gross error detection scheme as an example to describe the gross error detection process, but this application is not limited to this.
[0310] The elements in the initial pseudorange observation residual matrix are sorted in ascending order to obtain a sorted pseudorange observation residual sequence, which can be called the first sequence. Gross errors in the first sequence can be detected based on its upper and lower quartiles, for example, by determining whether each element in the first sequence is less than M. 1 / 4 -1.5*(M 3 / 4 -M 1 / 4 ) or greater than M 3 / 4 +1.5*(M 3 / 4 -M 1 / 4 To perform gross error detection on the first sequence. If all elements in the first sequence are not less than M... 1 / 4 -1.5*(M 3 / 4 -M 1 / 4 And not greater than M 3 / 4 +1.5*(M 3 / 4 -M 1 / 4 If M is true, then it is considered that there are no pseudorange observation sub-data that need to be removed, that is, the initial pseudorange observation residual matrix satisfies the gross error filtering condition. 1 / 4 M is the lower quartile of the first sequence. 3 / 4 It is the upper quartile of the first sequence.
[0311] For example, the initial pseudorange observation residual matrix may not meet the gross error filtering conditions. If the initial pseudorange observation residual matrix does not meet the gross error filtering conditions, the pseudorange observation sub-data that failed the gross error detection is removed from the first initial pseudorange observation data, and then subsequent steps are performed based on the remaining pseudorange observation data.
[0312] For example, if the initial observation residual matrix includes the initial Doppler observation residual matrix, then the initial Jacobian matrix includes the initial Doppler Jacobian matrix, and the initial measurement variance matrix includes the initial Doppler measurement variance matrix. The initial Doppler Jacobian matrix is the Jacobian matrix of the initial Doppler observation residual matrix with respect to the initial Doppler positioning result; 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 elevation angle of the first satellite.
[0313] The principle for obtaining the initial Doppler Jacobian matrix is the same as that for obtaining the pseudorange Jacobian matrix, and the principle for constructing the initial Doppler measurement variance matrix is the same as that for constructing the initial pseudorange measurement variance matrix; therefore, it will not be elaborated further here. For example, the Doppler observation error parameters on which the initial Doppler measurement variance matrix is constructed are... The settings can be based on experience or adjusted flexibly according to actual circumstances. This application does not limit the specific settings in this regard. For example...
[0314] In step 802, based on the initial observation residual matrix, the initial Jacobian matrix, and the initial measurement variance matrix, the positioning result correction is obtained, and the sum of the positioning result correction and the initial positioning result is used as the intermediate positioning result.
[0315] For example, the initial Jacobian matrix includes the initial pseudorange Jacobian matrix, the initial measurement variance matrix includes the initial pseudorange measurement variance matrix, the initial observation residual matrix includes the initial pseudorange observation residual matrix, the positioning result correction includes the pseudorange positioning result correction, the initial positioning result includes the initial pseudorange positioning result, and the intermediate positioning result includes the intermediate pseudorange positioning result. In this case, the implementation process of step 802 includes: obtaining the pseudorange positioning result correction based on the initial pseudorange Jacobian matrix, the initial pseudorange measurement variance matrix, and the initial pseudorange measurement variance matrix; and using the sum of the pseudorange positioning result correction and the initial pseudorange positioning result as the intermediate pseudorange positioning result.
[0316] For example, based on the pseudo-range Jacobian matrix G of the k-th iteration ρk The pseudorange observation residual matrix V of the kth iteration k And the pseudorange measurement variance matrix W of the k-th iteration. ρk To obtain the pseudorange localization result correction amount for the k-th iteration, the pseudorange localization result correction amount for the k-th iteration can be expressed as shown in Formula 32 below:
[0317]
[0318] Where, Δx ρ,k V represents the correction amount of the pseudorange localization result in the k-th iteration. k V represents the pseudorange observation residual matrix of the k-th iteration. k As shown in Formula 33 below:
[0319]
[0320] Where, r u,k dt r,k For the estimated position and clock bias of the mobile device during the k-th iteration, see Formula 27 for the meaning of other parameters.
[0321] The correction amount based on the pseudorange localization result of the kth iteration can be used to estimate the parameter x of the pseudorange localization result. u The update process is shown in Formula 34 below:
[0322] x u,k+1 =x u,k +Δx ρ,k (Formula 34)
[0323] Where, x u,k+1Let x represent the estimated parameters of the pseudorange localization result in the (k+1)th iteration. u,k Let Δx represent the estimated parameter of the pseudorange localization result in the k-th iteration (where k is an integer not less than 0). ρ,k This represents the correction amount for the pseudorange localization result in the k-th iteration.
[0324] For example, since the current iteration is the 0th iteration, the pseudorange localization result correction can be expressed as Δx. ρ,0 The initial pseudorange positioning result can be represented as x u,0 The intermediate pseudorange localization result can be represented as x u,1 The process of using the sum of the pseudorange positioning correction and the initial pseudorange positioning as the intermediate pseudorange positioning result can be represented as x. u,1 =x u,0 +Δx ρ,0 .
[0325] For example, the initial Jacobian matrix includes the initial Doppler Jacobian matrix, the initial measurement variance matrix includes the initial Doppler measurement variance matrix, the initial observation residual matrix includes the initial Doppler observation residual matrix, the positioning result correction includes the Doppler positioning result correction, the initial positioning result includes the initial Doppler positioning result, and the intermediate positioning result includes the intermediate Doppler positioning result. In this case, the implementation process of step 802 includes: obtaining the Doppler positioning result correction based on the initial Doppler Jacobian matrix, the initial Doppler measurement variance matrix, and the initial Doppler measurement variance matrix; and using the sum of the Doppler positioning result correction 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 elaborated here.
[0326] In step 803, in response to the intermediate positioning result satisfying the first selection condition, the calculated state parameters are obtained based on the intermediate positioning result.
[0327] For example, the intermediate positioning results include intermediate pseudorange positioning results and intermediate Doppler positioning results. The intermediate positioning results satisfying the first selection condition means that the intermediate pseudorange positioning results satisfy the first pseudorange selection condition and the intermediate Doppler positioning results satisfy the first Doppler selection condition.
[0328] For example, the process of determining whether the intermediate pseudorange positioning result meets the first pseudorange selection condition includes: in response to the pseudorange positioning result correction amount being less than the pseudorange correction amount threshold, 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, and the position and clock error of the first satellite; using the product of the transpose matrix of the intermediate pseudorange observation residual matrix, the inverse matrix of the initial pseudorange measurement variance matrix, and the intermediate pseudorange observation residual matrix as the pseudorange test statistic; and in response to the pseudorange test statistic being less than the pseudorange statistic threshold, determining that the intermediate pseudorange positioning result meets the first pseudorange selection condition.
[0329] The pseudorange correction threshold can be set empirically or adjusted flexibly according to the application scenario. This application embodiment does not limit this; for example, the pseudorange correction threshold is 10. -4 The pseudorange localization result correction amount being less than the pseudorange correction amount threshold can be expressed as ||Δx|| ρ,k ||<10 -4 For example, if the pseudorange positioning result correction is less than the pseudorange correction threshold, it can be said that the pseudorange positioning result correction has converged. For example, if the pseudorange positioning result correction is not less than the pseudorange correction threshold, then the intermediate pseudorange positioning result is used as the initial value for the pseudorange positioning of the next iteration, and steps 801 and 802 are repeated.
[0330] The principle for constructing the intermediate pseudorange observation residual matrix is the same as that for constructing the initial pseudorange observation residual matrix, and will not be repeated here. For example, the process of using the product of 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 can be achieved based on Equation 35:
[0331]
[0332] Where s represents the pseudorange detection statistic, W ρk Let V represent the initial pseudorange measurement variance matrix, and let V represent the intermediate pseudorange observation residual matrix. The form of V is shown in Equation 36 (V calculated when k is 0 in Equation 36 is the intermediate pseudorange observation residual matrix at this time). In some embodiments, V can also be called the post-test pseudorange observation residual matrix. Exemplarily, the process of determining whether the pseudorange test statistic is less than the pseudorange statistic threshold can also be called the process of performing a chi-square test on the intermediate pseudorange localization results.
[0333]
[0334] Where, r u,k+1 dt represents the position in the intermediate pseudorange localization result. r,k+1 This represents the clock error in the intermediate pseudorange positioning result. For the meaning of other parameters, please refer to Formula 27.
[0335] If the pseudorange test statistic is less than the pseudorange statistic threshold, then the intermediate pseudorange localization result is determined to meet the first pseudorange selection condition. The pseudorange statistic threshold is set based on experience or can be flexibly adjusted according to the application scenario; this application embodiment does not limit this.
[0336] For example, if the pseudorange test statistic is not less than the pseudorange statistic threshold, then the intermediate pseudorange positioning result is determined not to meet the first pseudorange selection condition. In this case, an initial pseudorange residual covariance matrix can be constructed based on the initial pseudorange Jacobi matrix and the initial pseudorange measurement variance matrix; the intermediate pseudorange observation residual matrix is tested based on the initial pseudorange residual covariance matrix to obtain the test result corresponding to each element in the intermediate pseudorange observation residual matrix; the pseudorange observation sub-data associated with elements whose test results are greater than the test threshold are removed from the first pseudorange observation data; based on the remaining pseudorange observation data and the intermediate pseudorange positioning result, a new intermediate pseudorange positioning result is obtained, and so on, until the new intermediate pseudorange positioning result meets the first pseudorange selection condition. The test threshold is set based on experience or flexibly adjusted according to the application scenario.
[0337] For example, the process of constructing the initial pseudorange residual covariance matrix based on the initial pseudorange Jacobi matrix and the initial pseudorange measurement variance matrix can be implemented based on Equation 37:
[0338]
[0339] Among them, C V W represents the initial pseudorange residual covariance matrix, also known as the posterior pseudorange residual covariance matrix; ρk G represents the initial pseudorange measurement variance matrix; ρk Let represent the initial pseudo-range Jacobian matrix.
[0340] For example, the pseudorange observation residual matrix (the pseudorange observation residual matrix after the apologetic residual, i.e., the pseudorange observation residual matrix V after the chi-square test) of the (k+1)th iteration is tested for normality using the apologetic residual covariance matrix, and the test results corresponding to each element in the pseudorange observation residual matrix of the (k+1)th iteration are obtained.
[0341] For example, testing the intermediate pseudorange observation residual matrix based on the initial pseudorange residual covariance matrix can refer to performing a normality test on the intermediate pseudorange observation residual matrix based on the initial pseudorange residual covariance matrix.
[0342] For example, the intermediate pseudorange observation residual matrix is tested based on the initial pseudorange residual covariance matrix to obtain the test result corresponding to each element in the intermediate pseudorange observation residual matrix. The process of removing pseudorange observation sub-data associated with elements whose test results are greater than the test threshold from the first pseudorange observation data is implemented based on formula 38:
[0343]
[0344] Among them, V i This represents the residual value corresponding to the first satellite i in the intermediate pseudorange observation residual matrix V, which is also the i-th element in the intermediate pseudorange observation residual matrix V; C V,ii This represents the covariance between the first satellite i and the first satellite i in the initial pseudorange residual covariance matrix; The i-th element in the intermediate pseudorange observation residual matrix V represents the test result; N(α) represents the upper quantile of the normal distribution with confidence level α, and also represents the test threshold.
[0345] For example, the process of determining whether the intermediate Doppler positioning result meets the first Doppler selection condition includes: in response to the Doppler positioning result correction being less than the Doppler correction threshold, 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 velocity and clock drift of the first satellite; using the product of the transpose of the intermediate Doppler observation residual matrix, the inverse matrix of the initial Doppler measurement variance matrix, and the intermediate Doppler observation residual matrix as the Doppler test statistic; and in response to the Doppler test statistic being less than the Doppler statistic threshold, determining that the intermediate Doppler positioning result meets the first Doppler selection condition. For example, the principle of determining whether the intermediate Doppler positioning result meets the first Doppler selection condition is the same as the principle of determining whether the intermediate pseudorange positioning result meets the first pseudorange selection condition, and will not be elaborated further here.
[0346] When it is determined that both the intermediate pseudorange positioning result and the intermediate Doppler positioning result satisfy the first pseudorange selection condition, the intermediate positioning result is determined to satisfy the first selection condition. Then, the calculated state parameters are obtained based on the intermediate positioning result. For example, the intermediate positioning result includes intermediate pseudorange positioning result and intermediate Doppler positioning result. The intermediate pseudorange positioning result includes position and clock bias, and the intermediate Doppler positioning result includes velocity and clock drift. The position and clock bias included in the intermediate pseudorange positioning result, and the velocity and clock drift included in the intermediate Doppler positioning result, are used as the calculated state parameters.
[0347] In an exemplary embodiment, after determining that the intermediate pseudorange positioning result meets the first pseudorange selection condition, the pseudorange observation random error model factor can also be adaptively estimated based on the following formula 39:
[0348]
[0349] in, Let V represent the pseudorange observation random error model factor, and W represent the intermediate pseudorange observation residual matrix. ρk denoted as the initial pseudorange measurement variance matrix, and n represents the number of pseudorange observation sub-data included in the intermediate pseudorange observation residual matrix, which is also the number of the first satellites.
[0350] In an exemplary embodiment, information such as intermediate pseudorange positioning results (position and clock error), pseudorange observation random error model factors, and remaining pseudorange observation sub-data when obtaining intermediate pseudorange positioning results can also be output for subsequent use.
[0351] In an exemplary embodiment, after determining that the intermediate Doppler positioning result satisfies the first Doppler selection condition, the Doppler observation random error model factor can be adaptively estimated. In an exemplary embodiment, information such as the intermediate Doppler positioning result (velocity and clock drift), the Doppler observation random error model factor, and the remaining Doppler observation sub-data obtained when acquiring the intermediate Doppler positioning result can also be output for subsequent use.
[0352] For example, the process of estimating the location and clock bias of a mobile device using robust weighted least squares can be as follows: Figure 9 As shown. Initial values for the estimated parameters are set, i.e., initial position and initial clock bias; a pseudorange observation residual matrix is constructed; gross error detection is performed on the pseudorange observation residual matrix based on quartiles. The Jacobian matrix of the pseudorange observation residual matrix with respect to the estimated parameters is calculated; a pseudorange measurement variance matrix is constructed. Parameter corrections are calculated, and the estimated parameters are updated. If the parameter corrections do not converge, the process returns to the step of constructing the pseudorange observation residual matrix. If the parameter corrections converge, the chi-square test statistic is calculated. If the chi-square test statistic is greater than a threshold, the post-hoc pseudorange residual covariance matrix is calculated, and a normality test is performed on the post-hoc pseudorange observation residual matrix based on the post-hoc pseudorange residual covariance matrix; pseudorange observation sub-data that fail the normality test is removed, and the process returns to the step of constructing the pseudorange observation residual matrix. If the chi-square test statistic is not greater than a threshold, the pseudorange observation random error model factor is adaptively estimated; the location, clock bias, pseudorange observation random error model factor, and information after removing pseudorange observation sub-data are output.
[0353] For example, the process of estimating the speed and clock drift of a mobile device using robust weighted least squares can be as follows: Figure 10As shown. Initial values for the estimated parameters are set, namely initial velocity and initial clock drift; the Doppler observation residual matrix is constructed; gross error detection is performed on the Doppler observation residual matrix based on quartiles. The Jacobian matrix of the Doppler observation residual matrix with respect to the estimated parameters is calculated; the Doppler measurement variance matrix is constructed. Parameter corrections are calculated, and the estimated parameters are updated. If the parameter corrections do not converge, the process returns to the step of constructing the Doppler observation residual matrix. If the parameter corrections converge, the chi-square test statistic is calculated. If the chi-square test statistic is greater than a threshold, the post-hoc Doppler residual covariance matrix is calculated, and a normality test is performed on the post-hoc Doppler observation residual matrix based on the post-hoc Doppler residual covariance matrix; Doppler observation sub-data that fails the normality test is removed, and the process returns to the step of constructing the Doppler observation residual matrix. If the chi-square test statistic is not greater than a threshold, the Doppler observation random error model factor is adaptively estimated; the speed, clock drift, Doppler observation random error model factor, and information after removing Doppler observation sub-data are output.
[0354] It should be noted that, Figure 5 and Figure 7 The embodiments shown are merely two exemplary implementation processes for obtaining a target positioning result based on a first positioning result when the target data includes first observation data and double-difference observation data. The embodiments of this application are not limited to these. In some embodiments, when the target data includes first observation data and double-difference observation data, the specific implementation process for obtaining a target positioning result based on a first positioning result may further include any of the following implementation processes:
[0355] Implementation process 1: Correct the first positioning result using double-difference observation data to obtain the third corrected result; correct the third corrected result using the first observation data to obtain the fourth corrected result, and use the fourth corrected result as the target positioning result.
[0356] The third correction result refers to the result obtained after correcting the first positioning result using double-difference observation data. The types of parameters included in the third correction result are the same as those included in the first positioning result. For example, the process of correcting the first positioning result using double-difference observation data to obtain the third correction result can be implemented using a second filter, and the implementation principle is the same as... Figure 5 The implementation principle of step 502 in the illustrated embodiment is the same.
[0357] The fourth correction result is obtained by correcting the third correction result using the first observation data. The fourth correction result is more reliable than the third correction result. Using the fourth correction result as the target positioning result for the mobile device helps ensure the reliability of the target positioning result and improves its positioning accuracy and robustness. For example, the process of correcting the third correction result using the first observation data to obtain the fourth correction result can be implemented using the first filter. The implementation principle is similar to... Figure 5 The implementation principle of step 501 in the illustrated embodiment is the same.
[0358] Method 2: Correct the first positioning result using the first observation data to obtain the first corrected result; use the double-difference observation data to position the mobile device to obtain the third positioning result; fuse the first corrected result and the third positioning result, and use the fused result as the target positioning result.
[0359] The process of correcting the first positioning result using the first observation data to obtain the first corrected result, and the process of locating the mobile device using double-difference observation data to obtain the third positioning result, are described in the preceding text and will not be repeated here. After obtaining the first corrected result and the 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. For example, the process of fusing the first corrected result and the third positioning result includes: obtaining the weights corresponding to the first corrected result and the third positioning result respectively, and fusing the first corrected result and the third positioning result based on the weights corresponding to the first corrected result and the third positioning result respectively.
[0360] Implementation process three: Correct the first positioning result using double-difference observation data to obtain the third corrected result; use the first observation data to locate the mobile device to obtain the second positioning result; fuse the third corrected result and the second positioning result, and use the fused result as the target positioning result.
[0361] The process of correcting the first positioning result using double-difference observation data to obtain the third corrected result, and the process of locating the mobile device using the first observation data to obtain the second positioning result, are described in the preceding text and will not be repeated here. After obtaining the third corrected result and the second positioning result, the third corrected result and the second positioning result are fused, and the fused result is used as the target positioning result. For example, the process of fusing the third corrected result and the second positioning result includes: obtaining the weights corresponding to the third corrected result and the second positioning result respectively, and fusing the third corrected result and the second positioning result based on the weights corresponding to the third corrected result and the second positioning result respectively.
[0362] Implementation process four: Correct the first positioning result using the first observation data to obtain the first corrected result; correct the first positioning result using the double-difference observation data to obtain the third corrected result; fuse the third corrected result and the first corrected result, and use the fused result as the target positioning result.
[0363] The process of correcting the first positioning result using the first observation data to obtain the first corrected result, and the process of correcting the first positioning result using double-difference observation data to obtain the third corrected result, are described in the previous sections and will not be repeated here. After obtaining the first and third corrected results, they are fused, and the fused result is used as the target positioning result. For example, the process of fusing the first and third corrected results includes: obtaining the weights corresponding to the first and third corrected results respectively, and fusing the first and third corrected results based on the weights corresponding to the first and third corrected results respectively.
[0364] Implementation process five: Use the first observation data to locate the mobile device and obtain the second positioning result; use the double-difference observation data to correct the second positioning result and obtain the fifth corrected result; fuse the fifth corrected result and the first positioning result, and use the fused result as the target positioning result.
[0365] The process of using the first observation data to locate the mobile device and obtain the second positioning result is described in the previous text and will not be repeated here. The principle of correcting the second positioning result using double-difference observation data is the same as the principle of correcting the first correction result using double-difference observation data. The result obtained after correcting the second positioning result using double-difference observation data is taken as the fifth correction result.
[0366] For example, the process of fusing the fifth correction result and the first positioning result includes: obtaining the 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.
[0367] Implementation process six: Use double-difference observation data to locate the mobile device and obtain the third positioning result; use the first observation data to correct the third positioning result and obtain the sixth corrected result; fuse the sixth corrected result and the first positioning result and use the fused result as the target positioning result.
[0368] The process of using double-difference observation data to locate the mobile device and obtain the third positioning result is described in the previous text and will not be repeated here. The principle of correcting the third positioning result using the first observation data is the same as that of correcting the first positioning result using the first observation data. The result obtained after correcting the third positioning result using the first observation data is taken as the sixth correction result.
[0369] For example, the process of fusing the sixth correction result and the first positioning result includes: obtaining the 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.
[0370] Implementation process seven: Use the first observation data to locate the mobile device and obtain the second location result; fuse the first location result and the second location result to obtain the first fused result; use the double-difference observation data to correct the first fused result and use the corrected result as the target location result.
[0371] The process of using the first observation data to locate the mobile device and obtain the second location result is described in the previous section and will not be repeated here. For example, the process of fusing the first and second location results to obtain the first fused result includes: obtaining the weights corresponding to the first and second location results respectively; and fusing the first and second location results based on these weights to obtain the first fused result.
[0372] The principle of correcting the first fusion result using double-difference observation data is the same as the principle of correcting the first correction result using double-difference observation data. The result obtained after correcting the first fusion result using double-difference observation data is used as the target positioning result of the mobile device.
[0373] Implementation process eight: Use double-difference observation data to locate the mobile device and obtain a third positioning result; fuse the first positioning result and the third positioning result to obtain a second fusion result; use the first observation data to correct the second fusion result and use the corrected result as the target positioning result.
[0374] The process of using double-difference observation data to locate a mobile device and obtain a third positioning result is described in the previous section and will not be repeated here. For example, the process of fusing the first and third positioning results to obtain a second fused result includes: obtaining the weights corresponding to the first and third positioning results respectively; and fusing the first and third positioning results based on these weights to obtain the second fused result.
[0375] The principle of correcting the second fusion result using the first observation data is the same as the principle of correcting the first positioning result using the first observation data. The result obtained after correcting the second fusion result using the first observation data is used as the target positioning result of the mobile device.
[0376] In an exemplary embodiment, the target data required to obtain the target positioning result based on the first positioning result may also include only the first observation data. In this case, the specific implementation process of obtaining the target positioning result based on the first positioning result based on the target data may include the following implementation process 1 and implementation process 2:
[0377] Implementation process 1: Correct the first positioning result using the first observation data to obtain the first corrected result, and use the first corrected result as the target positioning result.
[0378] The process of correcting the first positioning result using the first observation data to obtain the first corrected result is described in the previous section and will not be repeated here. After obtaining the first corrected result, it is directly used as the target positioning result of the mobile device.
[0379] Implementation process 2: Use the first observation data to locate the mobile device and obtain the second location result. Then, fuse the first and second location results and use the fused result as the target location result.
[0380] The process of using the first observation data to locate the mobile device and obtain the second location result is described in the previous text and will not be repeated here.
[0381] For example, the process of fusing the first positioning result and the second positioning result includes: obtaining the weights corresponding to the first positioning result and the second positioning result respectively; and fusing the first positioning result and the second positioning result based on the weights corresponding to the first positioning result and the second positioning result respectively. After fusion, the fused result is used as the target positioning result of the mobile device.
[0382] In an exemplary embodiment, the target data required to obtain the target positioning result based on the first positioning result may also only include double-difference observation data. In this 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:
[0383] Implementation process A: The first positioning result is corrected using double-difference observation data to obtain the third corrected result, which is then used as the target positioning result.
[0384] The process of correcting the first positioning result using double-difference observation data to obtain the third corrected result is described in the previous section and will not be repeated here. After obtaining the third corrected result, it is directly used as the target positioning result of the mobile device.
[0385] Implementation process B: Use double-difference observation data to locate the mobile device and obtain a third positioning result. Then, fuse the first and third positioning results and use the fused result as the target positioning result.
[0386] The process of using double-difference observation data to locate mobile devices and obtain a third positioning result is described in the previous text and will not be repeated here.
[0387] For example, the process of fusing the first positioning result and the third positioning result includes: obtaining the weights corresponding to the first positioning result and the third positioning result respectively, and fusing the first positioning result and the third positioning result based on the weights corresponding to the first positioning result and the third positioning result respectively. After fusion, the fused result is used as the target positioning result of the mobile device.
[0388] For example, one framework for a localization method can be as follows: Figure 11 As shown. The mobile device acquires observation data from the CORS system, including mobile device observation data, navigation ephemeris data, and base station observation data, based on the NTRIP protocol. The CORS system establishes a communication connection with the satellite. Based on the mobile device's observation data and navigation ephemeris, a first filter is used to obtain the second positioning result of the mobile device; based on the mobile device's observation data, base station observation data, and navigation ephemeris, an RTK algorithm and a second filter are used to obtain the third positioning result of the mobile device. Point cloud data scanned by the lidar installed on the mobile device is acquired, and adjacent frames of point cloud data are matched using the NDT algorithm to obtain the position change; based on the constraint equations corresponding to the position change, the first positioning result of the mobile device is obtained. The first, second, and third positioning results are fused to obtain the target positioning result, which is then output. By continuously outputting the latest target positioning result, the movement trajectory of the mobile device can be generated.
[0389] The process of obtaining positioning results based on filters involves filter fault detection and repair, clock error jump and clock drift jump detection and repair, filter model verification and repair, and gross error detection and removal. The process of obtaining the third positioning result involves fixing integer ambiguities based on MLAMBDA. If the fixing is successful, a fixed solution for the position is obtained; if the fixing fails, a floating-point solution for the position is obtained.
[0390] For example, a detailed process of the positioning method can be as follows: Figure 12 As shown. According to the steps in dashed box 1201, the process of obtaining the second positioning result of the mobile device based on the observation data and navigation ephemeris of the mobile device, using the first filter, is implemented. See the steps in dashed box 1201. Figure 5 Step 501 and Figure 8 The illustrated embodiment, and Figure 5 The difference in step 501 is that in dashed box 1201, the first filter is initialized (that is, the first state parameters of the first filter are determined) using the state parameters of the mobile device calculated based on robust weighted least squares and the first observation data, instead of determining the first state parameters of the first filter based on the first positioning result.
[0391] According to the steps in dashed box 1202, the process of obtaining the third positioning result of the mobile device based on the observation data of the mobile device, the observation data of the base station, and the navigation ephemeris, using the RTK algorithm and the second filter, is implemented. See [link to steps in dashed box 1202]. Figure 5 Step 502 in the text, and Figure 5 The difference in step 502 is that in dashed box 1202, the second filter is initialized (that is, the second state parameters of the second filter are determined) using the state parameters of the mobile device calculated based on robust weighted least squares and the first observation data, instead of determining the second state parameters of the second filter based on the first correction result.
[0392] The second and third positioning results are fused to obtain the fused result. Following the steps in dashed box 1203, the process of acquiring the first positioning result of the mobile device based on point cloud data is implemented. See [link to steps in dashed box 1203]. Figure 3 Step 301 in the illustrated embodiment: The fusion result and the first positioning result are fused to obtain the target positioning result, and the current target positioning result of the mobile device is output.
[0393] For example, the positioning method provided in this application embodiment can be applied in mobile terminal positioning and navigation application scenarios (e.g., electronic map applications), and can also be applied in lane-level navigation application scenarios, achieving sub-meter or lane-level positioning to assist lane-level positioning and navigation. Sub-meter positioning refers to positioning results with an accuracy of decimeters, centimeters, or even millimeters.
[0394] For example, embodiments of this application provide a positioning method that constructs position change constraint equations based on lidar point cloud matching information and fuses RTK and lidar based on Kalman filters. This reduces the dependence on satellite signals and can solve the problem of poor positioning accuracy in complex scenarios such as severe satellite signal obstruction and significant multipath effects. It also addresses the problems of discontinuous vehicle positioning and position jumps in complex scenarios such as high-rise buildings and urban canyons, and inaccurate vehicle positioning and position drift in complex urban scenarios such as weak satellite signal scenarios. This enhances the availability and reliability of satellite positioning in weak satellite signal scenarios and assists mobile phones and vehicle systems in lane-level positioning and navigation in road scenarios such as highways and overpasses (e.g., lane-level positioning and navigation). Figure 13 (As shown).
[0395] For example, the positioning method provided in the embodiments of this application can also be applied in other scenarios such as... Figure 14 As shown, by comprehensively considering satellite observation data (such as observation data from the mobile device itself, and double-difference observation data between the mobile device's observation data and the base station's observation data) and point cloud data, the target positioning result of the mobile device is obtained. Based on this positioning method, it can provide a foundation for lane-level navigation, identify yaw, lane changes, and main and auxiliary roads, and achieve high-precision positioning, stable positioning, and reliable positioning.
[0396] See Figure 15 This application provides a positioning device, which includes:
[0397] The first acquisition unit 1401 is used to acquire point cloud data scanned by the radar installed on the mobile device;
[0398] The positioning unit 1402 is used to locate the mobile device using point cloud data to obtain a first positioning result;
[0399] The second acquisition unit 1403 is used to acquire the first observation data received by the satellite positioning device installed on the mobile device;
[0400] The third acquisition unit 1404 is used to acquire the target positioning result of the mobile device based on the first observation data and the first positioning result.
[0401] In one possible implementation, the third acquisition unit 1404 is used to acquire target data based on the first observation data, the target data including at least one of the first observation data and double-difference observation data, the double-difference observation data being calculated based on the first observation data and the reference observation data received by the satellite positioning equipment installed at the reference station; and to acquire the target positioning result based on the target data and the first positioning result.
[0402] In one possible implementation, the target data includes first observation data and double-difference observation data. The third acquisition unit 1404 is used to correct the first positioning result using the first observation data to obtain a first corrected result; to correct the first corrected result using the double-difference observation data to obtain a second corrected result; and to use the second corrected result as the target positioning result.
[0403] In one possible implementation, the third acquisition unit 1404 is configured to acquire first state parameters of the first filter based on the first positioning result, and acquire the first state covariance matrix corresponding to the first state parameters; in response to the first observation data satisfying the first screening condition, acquire the first observation residual matrix based on the first observation data and the first state parameters; determine the first measurement update matrix and the first measurement variance matrix corresponding to the first observation residual matrix; determine the 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 use the sum of the first parameter increment and the first state parameters as the updated first state parameters of the first filter; in response to the updated first state parameters satisfying the first reference condition, acquire the first correction result based on the updated first state parameters.
[0404] In one possible implementation, the device further includes:
[0405] The determining unit is used to determine the covariance increment based on the first measurement update matrix, the first measurement variance matrix, and the first state covariance matrix; multiply the covariance increment by the first state covariance matrix to obtain the updated first state covariance matrix; perform correction detection on the first parameter increment based on the updated first state covariance matrix; in response to the correction detection passing, test the first observation residual matrix based on the first residual covariance matrix to obtain the test results corresponding to each element in the first observation residual matrix, the first residual covariance matrix being constructed based on the updated first state covariance matrix, the first measurement variance matrix, and the first measurement update matrix; in response to the test results corresponding to each element in the first observation residual matrix all satisfying the test conditions, determine that the updated first state parameter satisfies the first reference condition.
[0406] In one possible implementation, the determining unit is further configured to determine the model validation parameter value corresponding to the first filter based on the first observation data, the first state parameter, and the first state covariance matrix; in response to the model validation parameter value being less than a first threshold, obtain the test results of the observation sub-data in the first observation data; and in response to the test results of the observation sub-data in the first observation data all satisfying the retention condition, determine that the first observation data satisfies the first screening condition.
[0407] In one possible implementation, the third acquisition unit 1404 is configured to: determine the second state parameters of the second filter based on the first correction result; acquire the second state covariance matrix corresponding to the second state parameters; in response to the double-difference observation data satisfying the second screening condition, acquire the double-difference observation residual matrix based on the double-difference observation data and the second state parameters; determine the double-difference measurement update matrix and the double-difference measurement variance matrix corresponding to the double-difference observation residual matrix; determine the 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 use the sum of the second parameter increment and the second state parameters as the updated second state parameters of the second filter; and in response to the updated second state parameters satisfying the second reference condition, acquire the second correction result based on the updated second state parameters.
[0408] In one possible implementation, the updated second state parameter includes a floating-point solution for the position and a floating-point solution for the integer ambiguity. The third acquisition unit 1404 is used to fix the floating-point solution for the integer ambiguity. In response to successful fixing, the fixed solution for the position is calculated using the fixed solution for the integer ambiguity, and the result including the fixed solution for the position is used as the second correction result. In response to unsuccessful fixing, the result including the floating-point solution for the position is used as the second correction result.
[0409] In one possible implementation, the target data includes first observation data and double-difference observation data. The third acquisition unit 1404 is used to locate the mobile device using the first observation data to obtain a second positioning result; to locate the mobile device using the double-difference observation data to obtain a third positioning result; and to fuse the first positioning result, the second positioning result, and the third positioning result, and use the fused result as the target positioning result.
[0410] In one possible implementation, the third acquisition unit 1404 is used to calculate the state parameters of the mobile device based on the first observation data, and to obtain the second positioning result based on the calculated state parameters.
[0411] In one possible implementation, the third acquisition unit 1404 is used to acquire the first weight corresponding to the first positioning result, the second weight corresponding to the second positioning result, and the third weight corresponding to the third positioning result; based on the first weight, the second weight, and the third weight, the first positioning result, the second positioning result, and the third positioning result are fused, and the fused result is used as the target positioning result.
[0412] In one possible implementation, the positioning unit 1402 is used to match point cloud data with historical point cloud data in the previous frame to obtain point cloud matching information; determine the position change based on the point cloud matching information; correct the historical position of the mobile device based on the position change to obtain a first position; and use the positioning result including the first position as the first positioning result.
[0413] In one possible implementation, the target data includes first observation data and double-difference observation data. The third acquisition unit 1404 is used to correct the first positioning result using the double-difference observation data to obtain a third corrected result; and to correct the third corrected result using the first observation data to obtain a fourth corrected result, and to use the fourth corrected result as the target positioning result.
[0414] In one possible implementation, the target data includes first observation data and a third acquisition unit 1404, which is used to correct the first positioning result using the first observation data to obtain a first corrected result and use the first corrected result as the target positioning result; or, the first observation data is used to locate the mobile device to obtain a second positioning result, the first positioning result and the second positioning result are fused, and the fused result is used as the target positioning result.
[0415] In one possible implementation, the target data includes double-difference observation data. The third acquisition unit 1404 is used to correct the first positioning result using the double-difference observation data to obtain a third corrected result, and use the third corrected result as the target positioning result; or, the mobile device is positioned using the double-difference observation data to obtain a third positioning result, and the first positioning result and the third positioning result are fused, and the fused result is used as the target positioning result.
[0416] The positioning device provided in this application obtains the final target positioning result of the mobile device by comprehensively considering the point cloud data scanned by the radar installed on the mobile device and the first observation data received by the satellite positioning device. The point cloud data and the first observation data can complement each other. This positioning method can reduce the dependence on either the point cloud data or 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 considering the other data. The positioning robustness is good and it is conducive to meeting actual positioning needs.
[0417] It should be noted that the apparatus provided in the above embodiments is only illustrated by the division of the above functional units. In practical applications, the above functions can be assigned to different functional units as needed, that is, the internal structure of the device can be divided into different functional units to complete all or part of the functions described above. In addition, the apparatus and method embodiments provided in the above embodiments belong to the same concept, and their specific implementation process can be found in the method embodiments, which will not be repeated here.
[0418] Figure 16 This is a schematic diagram of the structure of a mobile device provided in an embodiment of this application. The mobile device can be: a mobile phone, a computer, a smart voice interaction device, a smart home appliance, a vehicle terminal, an aircraft, etc. The mobile device may also be referred to as user equipment, a portable terminal, a laptop terminal, a desktop terminal, or other names.
[0419] Typically, a mobile device includes a processor 1501 and a memory 1502.
[0420] Processor 1501 may include one or more processing cores, such as a quad-core processor, an octa-core processor, etc. Processor 1501 may be implemented using at least one hardware form selected from DSP (Digital Signal Processing), FPGA (Field-Programmable Gate Array), and PLA (Programmable Logic Array). Processor 1501 may also include a main processor and a coprocessor. The main processor, also known as a CPU (Central Processing Unit), is used to process data in the wake-up state; the coprocessor is a low-power processor used to process data in the standby state. In some embodiments, processor 1501 may integrate a GPU (Graphics Processing Unit), which is responsible for rendering and drawing the content required to be displayed on the screen. In some embodiments, processor 1501 may also include an AI (Artificial Intelligence) processor, which is used to handle computational operations related to machine learning.
[0421] The memory 1502 may include one or more computer-readable storage media, which may be non-transitory. The memory 1502 may also include high-speed random access memory and non-volatile memory, such as one or more disk storage devices or flash memory devices. In some embodiments, the non-transitory computer-readable storage media in the memory 1502 are used to store at least one instruction, which is executed by the processor 1501 to cause the mobile device to implement the positioning method provided in the method embodiments of this application.
[0422] In some embodiments, the mobile device may also optionally include: a peripheral device interface 1503 and at least one peripheral device. The processor 1501, memory 1502, and peripheral device interface 1503 can be connected via a bus or signal line. Each peripheral device can be connected to the peripheral device interface 1503 via a bus, signal line, or circuit board. Specifically, the peripheral device includes at least one of: a radio frequency circuit 1504, a display screen 1505, a camera assembly 1506, an audio circuit 1507, and a power supply 1508.
[0423] Peripheral interface 1503 can be used to connect at least one I / O (Input / Output) related peripheral device to processor 1501 and memory 1502. In some embodiments, processor 1501, memory 1502 and peripheral interface 1503 are integrated on the same chip or circuit board; in some other embodiments, any one or two of processor 1501, memory 1502 and peripheral interface 1503 can be implemented on separate chips or circuit boards, which is not limited in this embodiment.
[0424] The radio frequency (RF) circuit 1504 is used to receive and transmit RF (Radio Frequency) signals, also known as electromagnetic signals. The RF circuit 1504 communicates with communication networks and other communication devices via electromagnetic signals. The RF circuit 1504 converts electrical signals into electromagnetic signals for transmission, or converts received electromagnetic signals back into electrical signals. Optionally, the RF circuit 1504 includes: an antenna system, an RF transceiver, one or more amplifiers, a tuner, an oscillator, a digital signal processor, a codec chipset, a user identity module card, etc. The RF circuit 1504 can communicate with other mobile devices via at least one wireless communication protocol. This wireless communication protocol includes, but is not limited to: metropolitan area networks (MANs), various generations of mobile communication networks (2G, 3G, 4G, and 5G), wireless local area networks (WLANs), and / or WiFi (Wireless Fidelity) networks. In some embodiments, the RF circuit 1504 may also include circuitry related to NFC (Near Field Communication), which is not limited in this application.
[0425] Display screen 1505 is used to display a UI (User Interface). This UI may include graphics, text, icons, videos, and any combination thereof. When display screen 1505 is a touch display screen, it also has the ability to collect touch signals on or above its surface. These touch signals can be input as control signals to processor 1501 for processing. In this case, display screen 1505 can also be used to provide virtual buttons and / or a virtual keyboard, also known as soft buttons and / or a soft keyboard. In some embodiments, display screen 1505 may be a single screen, disposed on the front panel of the mobile device; in other embodiments, display screen 1505 may be at least two screens, disposed on different surfaces of the mobile device or in a folded design; in other embodiments, display screen 1505 may be a flexible display screen, disposed on a curved or folded surface of the mobile device. Furthermore, display screen 1505 may be configured as a non-rectangular, irregular shape, i.e., a non-rectangular screen. Display screen 1505 may be made of materials such as LCD (Liquid Crystal Display) or OLED (Organic Light-Emitting Diode).
[0426] The camera assembly 1506 is used to acquire images or videos. Optionally, the camera assembly 1506 includes a front-facing camera and a rear-facing camera. Typically, the front-facing camera is located on the front panel of the mobile device, and the rear-facing camera is located on the back of the mobile device. In some embodiments, there are at least two rear-facing cameras, which are any one of a main camera, a depth-sensing camera, a wide-angle camera, and a telephoto camera, to achieve background blurring by fusion of the main camera and the depth-sensing camera, panoramic shooting by fusion of the main camera and the wide-angle camera, VR (Virtual Reality) shooting, or other fusion shooting functions. In some embodiments, the camera assembly 1506 may also include a flash. The flash can be a single-color temperature flash or a dual-color temperature flash. A dual-color temperature flash refers to a combination of a warm-light flash and a cool-light flash, which can be used for light compensation at different color temperatures.
[0427] The audio circuit 1507 may include a microphone and a speaker. The microphone is used to collect sound waves from the user and the environment, converting the sound waves into electrical signals that are input to the processor 1501 for processing, or input to the radio frequency circuit 1504 for voice communication. For stereo sound acquisition or noise reduction purposes, multiple microphones may be used, each positioned in a different part of the mobile device. The microphone may also be an array microphone or an omnidirectional microphone. The speaker is used to convert electrical signals from the processor 1501 or the radio frequency circuit 1504 into sound waves. The speaker may be a conventional diaphragm speaker or a piezoelectric ceramic speaker. When the speaker is a piezoelectric ceramic speaker, it can convert electrical signals not only into audible sound waves but also into inaudible sound waves for purposes such as distance measurement. In some embodiments, the audio circuit 1507 may also include a headphone jack.
[0428] Power supply 1508 is used to power various components in a mobile device. Power supply 1508 can be AC power, DC power, a disposable battery, or a rechargeable battery. When power supply 1508 includes a rechargeable battery, the rechargeable battery can support wired or wireless charging. The rechargeable battery can also be used to support fast charging technology.
[0429] In some embodiments, the mobile device further includes one or more sensors 1509. The one or more sensors 1509 include, but are not limited to: an accelerometer 1510, a gyroscope 1511, a pressure sensor 1512, an optical sensor 1513, and a proximity sensor 1514.
[0430] Accelerometer 1510 can detect the magnitude of acceleration along the three axes of a coordinate system established by the mobile device. For example, accelerometer 1510 can be used to detect the components of gravitational acceleration along the three axes. Processor 1501 can control display screen 1505 to display the user interface in either a landscape or portrait view based on the gravitational acceleration signal acquired by accelerometer 1510. Accelerometer 1510 can also be used for games or for acquiring user motion data.
[0431] The gyroscope sensor 1511 can detect the orientation and rotation angle of the mobile device. The gyroscope sensor 1511 can work in conjunction with the accelerometer sensor 1510 to acquire the user's 3D movements on the mobile device. Based on the data acquired by the gyroscope sensor 1511, the processor 1501 can perform the following functions: motion sensing (e.g., changing the UI based on the user's tilt), image stabilization during shooting, game control, and inertial navigation.
[0432] The pressure sensor 1512 can be disposed on the side bezel of the mobile device and / or on the lower layer of the display screen 1505. When the pressure sensor 1512 is disposed on the side bezel of the mobile device, it can detect the user's grip signal on the mobile device, and the processor 1501 can perform left / right hand recognition or quick operation based on the grip signal collected by the pressure sensor 1512. When the pressure sensor 1512 is disposed on the lower layer of the display screen 1505, the processor 1501 can control the operable controls on the UI interface based on the user's pressure operation on the display screen 1505. The operable controls include at least one of button controls, scroll bar controls, icon controls, and menu controls.
[0433] Optical sensor 1513 is used to collect ambient light intensity. In one embodiment, processor 1501 can control the display brightness of display screen 1505 based on the ambient light intensity collected by optical sensor 1513. Specifically, when the ambient light intensity is high, the display brightness of display screen 1505 is increased; when the ambient light intensity is low, the display brightness of display screen 1505 is decreased. In another embodiment, processor 1501 can also dynamically adjust the shooting parameters of camera assembly 1506 based on the ambient light intensity collected by optical sensor 1513.
[0434] The proximity sensor 1514, also known as a distance sensor, is typically located on the front panel of a mobile device. The proximity sensor 1514 is used to detect the distance between the user and the front of the mobile device. In one embodiment, when the proximity sensor 1514 detects that the distance between the user and the front of the mobile device is gradually decreasing, the processor 1501 controls the display screen 1505 to switch from a screen-on state to a screen-off state; when the proximity sensor 1514 detects that the distance between the user and the front of the mobile device is gradually increasing, the processor 1501 controls the display screen 1505 to switch from a screen-off state to a screen-on state.
[0435] In some embodiments, the mobile device further includes a radar 1515 and a satellite positioning device 1516. The radar 1515 is used to scan point cloud data around the mobile device, and the satellite positioning device 1516 is used to receive first observation data corresponding to the mobile device, thereby enabling the mobile device to locate itself by comprehensively considering the point cloud data and the first observation data, thus improving the accuracy and robustness of the positioning.
[0436] Those skilled in the art will understand that Figure 16 The structure shown does not constitute a limitation on the mobile device and may include more or fewer components than illustrated, or combine certain components, or use different component arrangements.
[0437] Figure 17 This is a schematic diagram of a server structure provided in an embodiment of this application. The server can vary significantly due to differences in configuration or performance, and may include one or more Central Processing Units (CPUs) 1701 and one or more memories 1702. The one or more memories 1702 store at least one computer program, which is loaded and executed by the one or more processors 1701 to enable the server to implement the positioning methods provided in the various method embodiments described above. Of course, the server may also have wired or wireless network interfaces, a keyboard, and input / output interfaces for input and output. The server may also include other components for implementing device functions, which will not be elaborated upon here.
[0438] In an exemplary embodiment, a computer device is also provided, comprising a processor and a memory storing at least one computer program. The at least one computer program is loaded and executed by one or more processors to enable the computer device to implement any of the aforementioned positioning methods.
[0439] In an exemplary embodiment, a computer-readable storage medium is also provided, which stores at least one computer program that is loaded and executed by a processor of a computer device to enable the computer to implement any of the above-described positioning methods.
[0440] In one possible implementation, the aforementioned computer-readable storage medium may be a read-only memory (ROM), a random access memory (RAM), a compact disc read-only memory (CD-ROM), magnetic tape, floppy disk, and optical data storage device, etc.
[0441] In an exemplary embodiment, a computer program product is also provided, which includes a computer program or computer instructions that are loaded and executed by a processor to enable a computer to implement any of the above-described positioning methods.
[0442] It should be noted that all information (including but not limited to user device information, user personal information, etc.), data (including but not limited to data used for analysis, stored data, displayed data, etc.), and signals involved in this application have been authorized by the user or fully authorized by all parties, 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, and positioning results involved in this application were all obtained with full authorization.
[0443] It should be noted that the terms "first," "second," etc., used in this application are used to distinguish similar objects and are not necessarily used to describe a specific order or sequence. It should be understood that such data can be interchanged where appropriate so that the embodiments of this application described herein can be implemented in orders other than those illustrated or described herein. The embodiments described in the above exemplary embodiments do not represent all embodiments consistent with this application. Rather, they are merely examples of apparatuses and methods consistent with some aspects of this application as detailed in the appended claims.
[0444] It should be understood that "multiple" as used in this article refers to two or more. "And / or" describes the relationship between related objects, indicating that three relationships can exist. For example, A and / or B can represent: A alone, A and B simultaneously, or B alone. The character " / " generally indicates that the preceding and following related objects have an "or" relationship.
[0445] The above description is merely an exemplary embodiment of this application and is not intended to limit this application. Any modifications, equivalent substitutions, improvements, etc., made within the principles of this application should be included within the protection scope of this application.
Claims
1. A positioning method, characterized in that, The method includes: Obtain point cloud data scanned by the radar installed on the mobile device, use the point cloud data to locate the mobile device, and obtain a first location result; Acquire the first observation data received by the satellite positioning device installed on the mobile device; Based on the first observation data, target data is obtained, wherein the target data includes at least one of the first observation data or double-difference observation data, and the double-difference observation data is calculated based on the first observation data and the reference observation data received by the satellite positioning equipment installed at the reference station. Based on the target data, the target positioning result of the mobile device is obtained based on the first positioning result; Wherein, when the target data includes the first observation data and the double-difference observation data, obtaining the target positioning result of the mobile device based on the target data and the first positioning result includes: The first positioning result is corrected using the first observation data to obtain a first corrected result; the first corrected result is then corrected using the double-difference observation data to obtain a second corrected result, and the second corrected result is used as the target positioning result; or... The first positioning result is corrected using the 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 used as the target positioning result.
2. The method according to claim 1, characterized in that, The step of correcting the first positioning result using the first observation data to obtain a first corrected result includes: Based on the first positioning result, the first state parameter of the first filter is obtained, and the first state covariance matrix corresponding to the first state parameter is obtained. 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 parameter; a first measurement update matrix and a first measurement variance matrix corresponding to the first observation residual matrix are determined. Based on the first observation residual matrix, the first measurement update matrix, the first measurement variance matrix, and the first state covariance matrix, the first parameter increment is determined, and the sum of the first parameter increment and the first state parameter is used as the updated first state parameter of the first filter. In response to the updated first state parameter satisfying the first reference condition, the first correction result is obtained based on the updated first state parameter.
3. The method according to claim 2, characterized in that, The method further includes: Based on the first measurement update matrix, the first measurement variance matrix, and the first state covariance matrix, the covariance increment is determined, and the product of the covariance increment and the first state covariance matrix is used as the updated first state covariance matrix. The first parameter increment is corrected based on the updated first state covariance matrix; in response to the corrected amount detection passing, the first observation residual matrix is tested based on the first residual covariance matrix to obtain the test results corresponding to each element in the first observation residual matrix. The 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. In response to the fact that the test results corresponding to each element in the first observation residual matrix all satisfy the test conditions, it is determined that the updated first state parameter satisfies the first reference condition.
4. The method according to claim 2, characterized in that, The method further includes: Based on the first observation data, the first state parameters, and the first state covariance matrix, determine the model validation parameter values corresponding to the first filter; In response to the model validation parameter value being less than a first threshold, the test results of the observed sub-data in the first observation data are obtained. In response to the test results of the observed sub-data in the first observation data all satisfying the retention condition, it is determined that the first observation data satisfies the first screening condition.
5. The method according to claim 1, characterized in that, The step of correcting the first correction result using the double-difference observation data to obtain the second correction result includes: Based on the first correction result, the second state parameters of the second filter are determined, and the second state covariance matrix corresponding to the second state parameters is obtained. In response to the double-difference observation data satisfying the second screening condition, based on the double-difference observation data and the second state parameter, the double-difference observation residual matrix is obtained; the double-difference measurement update matrix and the double-difference measurement variance matrix corresponding to the double-difference observation residual matrix are determined. 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, the second parameter increment is determined, and the sum of the second parameter increment and the second state parameter is used as the updated second state parameter of the second filter. In response to the updated second state parameter satisfying the second reference condition, the second correction result is obtained based on the updated second state parameter.
6. The method according to claim 5, characterized in that, The updated second state parameters include a floating-point solution for the position and a floating-point solution for the integer ambiguity. Obtaining the second correction result based on the updated second state parameters includes: The floating-point solution of the integer ambiguity is fixed; In response to successful fixing, a fixed solution for the position is calculated using the fixed solution of the integer ambiguity, and the result including the fixed solution for the position is used as the second correction result; in response to unsuccessful fixing, the result including the floating-point solution for the position is used as the second correction result.
7. The method according to any one of claims 1-6, characterized in that, The step of using the point cloud data to locate the mobile device and obtain a first location result includes: The point cloud data is matched with historical point cloud data in the previous frame to obtain point cloud matching information. The position change is determined based on the point cloud matching information; The historical location of the mobile device is corrected based on the location change to obtain a first location, and the positioning result including the first location is used as the first positioning result.
8. The method according to claim 1, characterized in that, When the target data includes the first observation data, obtaining the target positioning result based on the target data and the first positioning result includes: The first positioning result is corrected using the first observation data to obtain a first corrected result, which is then used as the target positioning result; or... The mobile device is located using the first observation data to obtain a second location result. The first location result and the second location result are then fused, and the fused result is used as the target location result.
9. The method according to claim 1, characterized in that, When the target data includes the double-difference observation data, obtaining the target positioning result based on the target data and the first positioning result includes: The first positioning result is corrected using the double-difference observation data to obtain a third corrected result, which is then used as the target positioning result; or... The mobile device is located using the double-difference observation data to obtain a third positioning result. The first positioning result and the third positioning result are then fused, and the fused result is used as the target positioning result.
10. A positioning device, characterized in that, The device includes: The first acquisition unit is used to acquire point cloud data scanned by the radar installed on the mobile device; A positioning unit is used to locate the mobile device using the point cloud data to obtain a first positioning result; The second acquisition unit is used to acquire the first observation data received by the satellite positioning device installed on the mobile device; The third acquisition unit is configured to acquire target data based on the first observation data, wherein the target data includes at least one of the first observation data or double-difference observation data, wherein the double-difference observation data is calculated based on the first observation data and the reference observation data received by the satellite positioning equipment installed at the reference station; and based on the target data, acquire the target positioning result of the mobile device based on the first positioning result. Wherein, when the target data includes the first observation data and the double-difference observation data, the third acquisition unit is used to correct the first positioning result using the first observation data to obtain a first corrected result; correct the first corrected result using the double-difference observation data to obtain a second corrected result, and use the second corrected result as the target positioning result; or, correct the first positioning result using the double-difference observation data to obtain a third corrected result; correct the third corrected result using the first observation data to obtain a fourth corrected result, and use the fourth corrected result as the target positioning result.
11. The apparatus according to claim 10, characterized in that, The third acquisition unit is used to acquire the first state parameter of the first filter based on the first positioning result, and to acquire the first state covariance matrix corresponding to the first state parameter. 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 parameter; Determine the first measurement update matrix and the first measurement variance matrix corresponding to the first observation residual matrix; Based on the first observation residual matrix, the first measurement update matrix, the first measurement variance matrix, and the first state covariance matrix, a first parameter increment is determined, and the sum of the first parameter increment and the first state parameter is used as the updated first state parameter of the first filter; in response to the updated first state parameter satisfying the first reference condition, the first correction result is obtained based on the updated first state parameter.
12. The apparatus according to claim 11, characterized in that, The device further includes: The determining unit is configured to: determine the covariance increment based on the first measurement update matrix, the first measurement variance matrix, and the first state covariance matrix; multiply the covariance increment by the first state covariance matrix to obtain the updated first state covariance matrix; perform a correction detection on the first parameter increment based on the updated first state covariance matrix; in response to the correction detection passing, test the first observation residual matrix based on the first residual covariance matrix to obtain the test results corresponding to each element in the first observation residual matrix, wherein the 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 in response to the test results corresponding to each element in the first observation residual matrix all satisfying the test conditions, determine that the updated first state parameter satisfies the first reference condition.
13. The apparatus according to claim 11, characterized in that, The device further includes: The determining unit is configured to determine the model validation parameter value corresponding to the first filter based on the first observation data, the first state parameter, and the first state covariance matrix; in response to the model validation parameter value being less than a first threshold, obtain the test results of the observation sub-data in the first observation data; and in response to the test results of the observation sub-data in the first observation data all satisfying the retention condition, determine that the first observation data satisfies the first screening condition.
14. The apparatus according to claim 10, characterized in that, The third acquisition unit is used to determine the second state parameters of the second filter based on the first correction result, and to acquire the second state covariance matrix corresponding to the second state parameters. In response to the double-difference observation data satisfying the second screening condition, the double-difference observation residual matrix is obtained based on the double-difference observation data and the second state parameter; Determine the double-difference measurement update matrix and double-difference measurement variance matrix corresponding to the double-difference observation residual matrix; 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, the second parameter increment is determined, and the sum of the second parameter increment and the second state parameter is used as the updated second state parameter of the second filter; in response to the updated second state parameter satisfying the second reference condition, the second correction result is obtained based on the updated second state parameter.
15. The apparatus according to claim 14, characterized in that, The updated second state parameter includes a floating-point solution for the position and a floating-point solution for the integer ambiguity. The third acquisition unit is used to fix the floating-point solution for the integer ambiguity. In response to successful fixing, the fixed solution for the position is calculated using the fixed solution for the integer ambiguity, and the result including the fixed solution for the position is used as the second correction result. In response to failure to fix, the result of the floating-point solution including the said position is used as the second correction result.
16. The apparatus according to any one of claims 10-15, characterized in that, The positioning unit is used to match the point cloud data with historical point cloud data in the previous frame to obtain point cloud matching information; and to determine the position change based on the point cloud matching information. The historical location of the mobile device is corrected based on the location change to obtain a first location, and the positioning result including the first location is used as the first positioning result.
17. The apparatus according to claim 10, characterized in that, When the target data includes the first observation data, the third acquisition unit is used to correct the first positioning result using the first observation data to obtain a first correction result, and use the first correction result as the target positioning result; or, it uses the first observation data to locate the mobile device to obtain a second positioning result, fuses the first positioning result and the second positioning result, and uses the fused result as the target positioning result.
18. The apparatus according to claim 10, characterized in that, When the target data includes the double-difference observation data, the third acquisition unit is used to correct the first positioning result using the double-difference observation data to obtain a third corrected result, and use the third corrected result as the target positioning result; or, it uses the double-difference observation data to locate the mobile device to obtain a third positioning result, fuses the first positioning result and the third positioning result, and uses the fused result as the target positioning result.
19. A computer device, characterized in that, The computer device includes a processor and a memory, the memory storing at least one computer program, which is loaded and executed by the processor to enable the computer device to implement the positioning method as described in any one of claims 1 to 9.
20. A computer-readable storage medium, characterized in that, The computer-readable storage medium stores at least one computer program, which is loaded and executed by a processor to enable the computer to implement the positioning method as described in any one of claims 1 to 9.
21. A computer program product, characterized in that, The computer program product includes a computer program or computer instructions, which are loaded and executed by a processor to enable the computer to implement the positioning method as described in any one of claims 1 to 9.
