Spatial positioning method and device, equipment, storage medium and product
By obtaining the floating point solution ambiguity and variance covariance matrix in spatial positioning technology, and using historical fixed ambiguity for optimal solution, the high-precision positioning problem when the ambiguity cannot be fixed is solved, and high-precision spatial positioning is achieved.
Patent Information
- Application Number
- CN202411192989.0
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-28
- Publication Date
- 2024-12-06
AI Technical Summary
The existing spatial positioning technology is difficult to obtain high-precision positioning when external environmental interference and low-cost hardware quality is low, especially when the ambiguity parameters cannot be fixed, which cannot meet the high-precision positioning requirements.
Search the integer domain by obtaining the floating-point solution ambiguity and variance covariance matrix. If the test value is less than the preset threshold, the historical fixed ambiguity will be obtained, and the optimal solution is performed based on the observation equation to determine the fixed solution position of the current epoch. .
When the ambiguity of the current epoch cannot be fixed, by using the historical fixed ambiguity for optimal solution, high-precision spatial positioning results can be obtained to meet the requirements of positioning accuracy.
Smart Images

Figure CN119087486A_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the field of space positioning technology, and in particular to a space positioning method, device, equipment, storage medium and product. Background Art
[0002] With the advancement of informatization, the importance of precision positioning technology continues to increase. Based on the differences in baseline distance and base station layout, GNSS (Global Navigation Satellite System) precision relative positioning technology is mainly composed of RTK (Real-time Kinematic Positioning) technology. In order to obtain high-precision positioning results, spatial positioning technology requires integer solution of ambiguity parameters, but it is usually affected by external environmental interference or low-quality low-cost hardware, and it may be difficult to obtain good observation quality, which affects the fixation of ambiguity parameters, making it impossible to obtain a fixed solution, and the positioning accuracy cannot meet the requirements.
[0003] In the existing positioning process, the parameter estimation process based on the Kalman filter method can obtain a floating-point solution for the ambiguity, but the corresponding baseline vector solution has low accuracy. The ambiguity floating-point solution is fixed to an integer by using the LAMBDA (Least-square AmbiguityDecorrelation Adjustment) search algorithm to obtain a fixed solution for the baseline vector, thereby reducing the positioning accuracy to the centimeter level or even the millimeter level. Therefore, in spatial positioning technology, ambiguity resolution is crucial. Existing spatial positioning technology usually directly uses the ambiguity parameters at two frequency points for search and fixation, but due to the poor accuracy of the observation values, it is difficult to fix the ambiguity parameters and it is impossible to obtain accurate positioning information.
[0004] Therefore, how to achieve high-precision spatial positioning when the ambiguity of the current epoch cannot be fixed is a problem that needs to be solved urgently.
[0005] The above contents are only used to assist in understanding the technical solution of the present application and do not constitute an admission that the above contents are prior art. Summary of the invention
[0006] The main purpose of this application is to provide a spatial positioning method, aiming to solve the technical problem of how to achieve high-precision spatial positioning when the ambiguity of the current epoch cannot be fixed.
[0007] To achieve the above purpose, the present application proposes a spatial positioning method, which comprises:
[0008] Get floating point deambiguation and variance covariance matrix;
[0009] Performing integer domain search on the floating point ambiguity resolution and the variance-covariance matrix to obtain a test value of a current epoch;
[0010] If the test value is less than a preset test threshold, the historical fixed ambiguity is obtained, and the historical fixed ambiguity is optimally solved based on the observation equation to obtain the fixed solution position of the current epoch.
[0011] In one embodiment, the step of acquiring historical fixed ambiguities, performing optimal solution on the historical fixed ambiguities based on observation equations, and obtaining the fixed solution position of the current epoch comprises:
[0012] Get the historical fixed ambiguities of the previous epoch;
[0013] Based on the observation equation, the historical fixed ambiguity is optimally solved to obtain the optimal solution of the position estimation parameters;
[0014] Coordinate parameters are extracted for the optimal solution of the position estimation parameters to obtain a fixed solution position of the current epoch.
[0015] In some feasible embodiments, the step of performing optimal solution on the historical fixed ambiguity based on the observation equation to obtain the optimal solution of the position estimation parameter comprises:
[0016] Based on the observation equation, the historical fixed ambiguity is solved by least squares to obtain the optimal solution of the position estimation parameter, wherein the observation equation includes:
[0017] Y=HX+v
[0018] X=(H T H) -1 (Hv)
[0019] Where Y is the sum of the phase observation value and the historical fixed ambiguity, H is the coefficient matrix of the observation vector, v is the observation noise, is the position estimation parameter, x, y, z are the coordinate components in the geocentric rectangular coordinate system, and T represents the matrix transpose.
[0020] In some feasible embodiments, the step of acquiring historical fixed ambiguities, performing optimal solution on the historical fixed ambiguities based on observation equations, and obtaining the fixed solution position of the current epoch comprises:
[0021] Determine whether the historical fixed ambiguity of the previous epoch exists;
[0022] If the historical fixed ambiguity of the previous epoch does not exist, the integer ambiguity of the current epoch is obtained, and based on the filtering algorithm, the integer ambiguity is subjected to filtering constraints to obtain the optimized integer ambiguity;
[0023] Based on the observation equation, the optimized integer ambiguity is optimally solved to obtain the optimal solution of the position estimation parameters of the current epoch;
[0024] Coordinate parameters are extracted for the optimal solution of the position estimation parameters to obtain a fixed solution position of the current epoch.
[0025] In some feasible embodiments, the step of performing integer domain search on the floating point ambiguity resolution and the variance-covariance matrix to obtain the test value of the current epoch includes:
[0026] Performing integer domain search on the floating point solution ambiguity and the variance covariance matrix through a search algorithm to obtain an optimal integer solution and a suboptimal integer solution;
[0027] The ratio of the residual quadratic form of the suboptimal integer solution to the residual quadratic form of the optimal integer solution is used as a test value of the current epoch.
[0028] In one embodiment, if the test value is less than a preset test threshold, the step of obtaining the historical fixed ambiguity further includes:
[0029] If the verification value is greater than or equal to a preset verification threshold, the integer ambiguity of the current epoch is obtained;
[0030] Fixing the integer ambiguity of the current epoch to a fixed ambiguity;
[0031] Based on the observation equation, the fixed ambiguity is optimally solved to obtain the optimal position estimation parameters of the current epoch;
[0032] Coordinate parameter extraction is performed on the optimal position estimation parameters to obtain a fixed solution position of the current epoch.
[0033] In addition, to achieve the above-mentioned purpose, the present application also proposes a spatial positioning device, which includes:
[0034] The acquisition module is used to obtain the floating point ambiguity resolution and variance covariance matrix;
[0035] A search module, configured to perform integer domain search on the floating point ambiguity resolution and the variance-covariance matrix to obtain a test value of a current epoch;
[0036] A calculation module is used to obtain historical fixed ambiguity if the test value is less than a preset test threshold, and to perform optimal solution on the historical fixed ambiguity based on the observation equation to obtain the fixed solution position of the current epoch.
[0037] In addition, to achieve the above-mentioned purpose, the present application also proposes a spatial positioning device, which includes: a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the computer program is configured to implement the steps of the spatial positioning method described above.
[0038] In addition, to achieve the above-mentioned purpose, the present application also proposes a storage medium, which is a computer-readable storage medium, and a computer program is stored on the storage medium. When the computer program is executed by a processor, the steps of the spatial positioning method described above are implemented.
[0039] In addition, to achieve the above-mentioned purpose, the present application also provides a computer program product, which includes a computer program, and when the computer program is executed by a processor, the steps of the spatial positioning method described above are implemented.
[0040] One or more technical solutions proposed in this application have at least the following technical effects:
[0041] Compared with the related art, it is usually to directly use the ambiguity parameters on the two frequency points to search and solve the fixed ambiguity to obtain a high-precision spatial position. However, if the accuracy of the observation value is poor and it is difficult to fix the ambiguity parameters, it will lead to the inability to obtain accurate positioning information. In comparison, when the ambiguity of the current epoch cannot be fixed, the present application obtains the historical fixed ambiguity, and optimally solves the historical fixed ambiguity based on the observation equation to determine the fixed solution position of the current epoch. It can be understood that the present application increases the use of historical fixed ambiguity information. When the ambiguity at the current moment is difficult to fix, the fixed ambiguity at the current moment is replaced by the historical fixed ambiguity at the same position to meet the ambiguity requirements of the observation equation. Therefore, the optimal solution of the historical fixed ambiguity based on the observation equation can be obtained to obtain the optimal solution of the current epoch, and then determine the fixed solution position of the current epoch, and finally complete high-precision spatial positioning. BRIEF DESCRIPTION OF THE DRAWINGS
[0042] The accompanying drawings, which are incorporated in and constitute a part of this specification, illustrate embodiments consistent with the present application and, together with the description, serve to explain the principles of the present application.
[0043] In order to more clearly illustrate the embodiments of the present application or the technical solutions in the prior art, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. Obviously, for ordinary technicians in this field, other drawings can be obtained based on these drawings without paying any creative labor.
[0044] Figure 1 A schematic diagram of a flow chart of a first embodiment of the spatial positioning method provided by the present application;
[0045] Figure 2 A brief flowchart of the spatial positioning method provided in the embodiment of the present application;
[0046] Figure 3 This is a schematic diagram of the module structure of the spatial positioning device according to an embodiment of the present application;
[0047] Figure 4 Schematic diagram of the device structure of the hardware operating environment involved in the spatial positioning method in the embodiment of the present application.
[0048] The purpose, features and advantages of this application will be further described in conjunction with the embodiments and with reference to the accompanying drawings. DETAILED DESCRIPTION
[0049] It should be understood that the specific embodiments described herein are only used to explain the technical solutions of the present application and are not used to limit the present application.
[0050] In order to better understand the technical solution of the present application, a detailed description will be given below in conjunction with the accompanying drawings and specific implementation methods.
[0051] The main solution of the embodiment of the present application is: obtaining the floating-point solution ambiguity and the variance-covariance matrix of the current epoch; performing an integer domain search on the floating-point solution ambiguity and the variance-covariance matrix to obtain a test value of the current epoch; if the test value is less than a preset test threshold, obtaining the historical fixed ambiguity, performing an optimal solution on the historical fixed ambiguity based on the observation equation, and obtaining the fixed solution position of the current epoch.
[0052] In this embodiment, for the convenience of description, the following description is made with a computer as the execution subject.
[0053] Existing spatial positioning technologies usually directly use the ambiguity parameters at two frequency points to search and fix them. However, due to the poor accuracy of the observation values, it is difficult to fix the ambiguity parameters and it is impossible to obtain accurate positioning information.
[0054] The present application provides a solution. Compared with the related art, which usually directly uses the ambiguity parameters on two frequency points to search and solve the fixed ambiguity to obtain a high-precision spatial position. However, if the observation value accuracy is poor and it is difficult to fix the ambiguity parameters, it will lead to the inability to obtain accurate positioning information. In comparison, the present application obtains the historical fixed ambiguity when the ambiguity of the current epoch cannot be fixed, and optimally solves the historical fixed ambiguity based on the observation equation to determine the fixed solution position of the current epoch. It can be understood that the present application increases the use of historical fixed ambiguity information. When the ambiguity at the current moment is difficult to fix, the fixed ambiguity at the current moment is replaced by the historical fixed ambiguity at the same position to meet the ambiguity requirements of the observation equation. Therefore, the optimal solution of the historical fixed ambiguity based on the observation equation can be obtained to obtain the optimal solution of the current epoch, and then determine the fixed solution position of the current epoch, and finally complete high-precision spatial positioning.
[0055] It should be noted that the execution subject of this embodiment can be a computing service device with data processing, network communication and program running functions, such as a tablet computer, a personal computer, a mobile phone, etc., or an electronic device capable of realizing the above functions, etc. The following takes a computer as an example to illustrate this embodiment and the following embodiments.
[0056] Based on this, the present application embodiment provides a spatial positioning method, referring to Figure 1 , Figure 1 This is a schematic diagram of the flow chart of the first embodiment of the spatial positioning method of the present application.
[0057] In this embodiment, the spatial positioning method includes steps S10 to S30:
[0058] Step S10, obtaining floating point ambiguity resolution and variance covariance matrix;
[0059] It should be noted that by acquiring the RTK filter of the current epoch, the floating point ambiguity resolution and the corresponding variance-covariance matrix of the current epoch are analyzed and obtained. The RTK filter is the satellite signal data after the noise reduction process.
[0060] In addition, it should be noted that the floating point ambiguity solution is a non-integer solution of the ambiguity parameter obtained by algorithm processing, and the variance-covariance matrix is a matrix containing statistical information of all ambiguity estimation values.
[0061] In this implementation, by analyzing the RTK filter, the floating point solution ambiguity and the corresponding equation covariance matrix are obtained, thereby solving the problem of large errors in the obtained ambiguity parameters.
[0062] The above is only a feasible implementation of step S10 provided in this embodiment, and this embodiment does not specifically limit the specific implementation of step S10.
[0063] Step S20, performing integer domain search on the floating point ambiguity resolution and the variance-covariance matrix to obtain a test value of the current epoch;
[0064] It should be noted that the check value of the current epoch is obtained by performing an integer domain search on the floating-point solution ambiguity and the variance-covariance matrix using the LAMBDA search algorithm. The LAMBDA search algorithm is a least squares ambiguity reduction correlation adjustment method. The check value is the ratio of the residual quadratic form of the suboptimal integer solution to the residual quadratic form of the optimal integer solution, which characterizes the degree of approximation between the floating-point solution and the optimal integer solution.
[0065] In addition, it should be noted that the epoch is a time mark used to identify a specific moment of data collection, and is a basic time unit for time measurement and satellite data processing.
[0066] The floating point solution ambiguity and the equation covariance matrix are searched in the integer domain by the LAMBDA search algorithm to obtain the suboptimal integer solution and the optimal integer solution of the current epoch, and the ratio of the residual quadratic form of the suboptimal integer solution to the residual quadratic form of the optimal integer solution is used as a check value.
[0067] In a feasible implementation, step S20 may include:
[0068] Performing integer domain search on the floating point solution ambiguity and the variance covariance matrix through a search algorithm to obtain an optimal integer solution and a suboptimal integer solution;
[0069] The ratio of the residual quadratic form of the suboptimal integer solution to the residual quadratic form of the optimal integer solution is used as a test value of the current epoch.
[0070] In a specific implementation, the floating-point solution ambiguity and the variance-covariance matrix are searched in the integer domain through the LAMBDA search algorithm to obtain the optimal integer solution and the suboptimal integer solution of the current epoch, and the ratio of the residual quadratic form of the suboptimal integer solution to the residual quadratic form of the optimal integer solution is taken as the ratio value, and the ratio value is judged according to a preset threshold.
[0071] It should be noted that the LAMBDA search algorithm is a least squares ambiguity reduction correlation adjustment method, the epoch is a time mark used to identify the specific moment of data collection, and is a basic time unit for time measurement and satellite data processing. The optimal integer solution is the integer solution when the objective function achieves the minimum value in the integer least squares estimation process, and the suboptimal integer solution refers to an integer solution whose objective function value is slightly greater than the optimal integer solution.
[0072] In addition, it should be noted that the floating-point ambiguity solution is a non-integer solution of the ambiguity parameters obtained by algorithm processing, the variance-covariance matrix is a matrix containing statistical information of all ambiguity estimates, and the integer domain search means that in GNSS positioning, since integer solutions cannot be obtained by direct observation, the LAMBDA search algorithm is needed to search for suitable solutions in the integer domain.
[0073] It should be noted that the ratio value is the ratio of the residual quadratic form of the suboptimal integer solution to the residual quadratic form of the optimal integer solution, which represents the degree of approximation between the floating-point solution and the optimal integer solution, and the preset threshold is a specific fixed value.
[0074] In this implementation, the floating-point solution ambiguity and the variance-covariance matrix are searched in the integer domain through the LAMBDA search algorithm to obtain the optimal integer solution and the suboptimal integer solution of the current epoch, and the ratio of the residual quadratic form of the suboptimal integer solution to the residual quadratic form of the optimal integer solution is used as the ratio value. The ratio value is judged according to a preset threshold, thereby solving the problem that the ambiguity cannot be judged.
[0075] The above is only a feasible implementation of step S20 provided in this embodiment, and this embodiment does not specifically limit the specific implementation of step S20.
[0076] Step S30: If the test value is less than a preset test threshold, the historical fixed ambiguity is obtained, and the historical fixed ambiguity is optimally solved based on the observation equation to obtain the fixed solution position of the current epoch.
[0077] It should be noted that if the test value is less than a preset test threshold, the historical fixed ambiguity is obtained, and the historical fixed ambiguity is optimally solved based on the observation equation to obtain the fixed solution position of the current epoch.
[0078] In addition, it should be noted that the check value is the ratio of the residual quadratic form of the suboptimal integer solution to the residual quadratic form of the optimal integer solution, which represents the degree of approximation between the floating-point solution and the optimal integer solution. The preset threshold is a preset fixed value. The least squares method is a mathematical optimization technique that finds the best function match for data by minimizing the sum of squares of errors.
[0079] The historical fixed ambiguity is the historical ambiguity information of the same position before the current epoch. The observation equation is a mathematical model that describes the relationship between the received signal measurement value and the actual geometric distance. The epoch is a time mark used to identify the specific moment of data collection, and is the basic time unit for time measurement and satellite data processing. The least squares solution refers to solving the target observation equation by the least squares method. The fixed solution position is a high-precision three-dimensional position coordinate.
[0080] In a feasible implementation, step S30 may include:
[0081] Get the historical fixed ambiguities of the previous epoch;
[0082] Based on the observation equation, the historical fixed ambiguity is optimally solved to obtain the optimal solution of the position estimation parameters;
[0083] Coordinate parameters are extracted for the optimal solution of the position estimation parameters to obtain a fixed solution position of the current epoch.
[0084] It should be noted that the historical fixed ambiguity is the fixed historical ambiguity information of the same position in the previous epoch, which meets the requirement of solving the observation equation with high precision spatial position, and the fixed solution position is a high precision three-dimensional position coordinate.
[0085] In a specific implementation, the step of performing optimal solution on the historical fixed ambiguity based on the observation equation to obtain the optimal solution of the position estimation parameter includes:
[0086] Based on the observation equation, the historical fixed ambiguity is solved by least squares to obtain the optimal solution of the position estimation parameter, wherein the observation equation includes:
[0087] Y=HX+v
[0088] X=(H T H) -1 (Hv)
[0089] Where Y is the sum of the phase observation value and the historical fixed ambiguity, H is the coefficient matrix of the observation vector, v is the observation noise, is the position estimation parameter, x, y, z are the coordinate components in the geocentric rectangular coordinate system, and T represents the matrix transpose;
[0090] In a specific implementation, if the ratio value is less than a preset threshold, the historical fixed ambiguity of the previous epoch is obtained; based on the observation equation, the historical fixed ambiguity is solved by least squares to obtain the optimal solution of the position estimation parameter, wherein the observation equation includes:
[0091] Y=HX+v
[0092] X=(H T H) -1 (Hv)
[0093] Where Y is the sum of the phase observation value and the historical fixed ambiguity, H is the coefficient matrix of the observation vector, v is the observation noise, is the position estimation parameter, x, y, z are the coordinate components in the ECEF coordinate system, and T represents the matrix transpose.
[0094] It should be noted that the ratio value is the ratio of the residual quadratic form of the suboptimal integer solution to the residual quadratic form of the optimal integer solution, which represents the degree of approximation between the floating-point solution and the optimal integer solution. The preset threshold is a specific fixed value, and the historical fixed ambiguity is the fixed historical ambiguity information of the previous epoch.
[0095] In addition, it should be noted that the phase observation value is obtained by a positioning device, the coefficient matrix is a three-dimensional vector calculated from the phase observation value, the observation noise is calculated from the altitude angle of the phase observation value, and the ECEF coordinate system is a geocentric rectangular coordinate system.
[0096] In this implementation, the historical fixed ambiguity of the previous epoch is obtained; based on the observation equation, the historical fixed ambiguity is optimally solved to obtain the optimal solution for the position estimation parameters; the coordinate parameters of the optimal solution for the position estimation parameters are extracted to obtain the fixed solution position of the current epoch, thereby solving the technical problem that high-precision spatial positioning cannot be completed when the ambiguity of the current epoch cannot be fixed.
[0097] In a feasible implementation, step S30 may include:
[0098] Determine whether the historical fixed ambiguity of the previous epoch exists;
[0099] If the historical fixed ambiguity of the previous epoch does not exist, the integer ambiguity of the current epoch is obtained, and based on the filtering algorithm, the integer ambiguity is subjected to filtering constraints to obtain the optimized integer ambiguity;
[0100] Based on the observation equation, the optimized integer ambiguity is optimally solved to obtain the optimal solution of the position estimation parameters of the current epoch;
[0101] Coordinate parameters are extracted for the optimal solution of the position estimation parameters to obtain a fixed solution position of the current epoch.
[0102] It should be noted that the historical fixed ambiguity is the fixed historical ambiguity information of the same position in the previous epoch, which meets the requirement of solving the observation equation for high-precision spatial position.
[0103] In a specific implementation, when the historical fixed ambiguity of the previous epoch is missing, the floating-point solution ambiguity and the variance-covariance matrix are searched in the integer domain through the LAMBDA search algorithm to obtain the integer ambiguity of the current epoch; the integer ambiguity is filtered and constrained to obtain the optimized integer ambiguity; based on the observation equation, the optimized integer ambiguity is optimally solved to obtain the optimal position estimation parameters of the current epoch; the coordinate parameters of the optimal position estimation parameters are extracted to obtain the fixed solution position.
[0104] It should be noted that the LAMBDA search algorithm is a least squares ambiguity reduction correlation adjustment method, the epoch is a time mark used to identify the specific time of data collection, and is the basic time unit for time measurement and satellite data processing. The integer ambiguity is an integer unknown corresponding to the first observed value of the phase difference between the carrier phase and the reference phase in the GPS carrier phase measurement. The floating-point ambiguity solution is a non-integer solution of the ambiguity parameter obtained by algorithm processing. The variance-covariance matrix is a matrix containing statistical information of all ambiguity estimates. The integer domain search means that in GNSS positioning, since integer solutions cannot be obtained by direct observation, the LAMBDA search algorithm is needed to search for suitable solutions in the integer domain.
[0105] In this implementation, it is determined whether the historical fixed ambiguity of the previous epoch exists; if the historical fixed ambiguity of the previous epoch does not exist, the integer ambiguity of the current epoch is obtained, and based on a filtering algorithm, the integer ambiguity is filtered and constrained to obtain an optimized integer ambiguity; based on the observation equation, the optimized integer ambiguity is optimally solved to obtain an optimal solution for the position estimation parameters of the current epoch; coordinate parameters are extracted from the optimal solution for the position estimation parameters to obtain the fixed solution position of the current epoch, which solves the technical problem that the ambiguity of the current epoch cannot be fixed and high-precision spatial positioning cannot be completed if the historical fixed ambiguity of the previous epoch does not exist.
[0106] The above are only two feasible implementations of step S30 provided in this embodiment, and this embodiment does not specifically limit the specific implementation of step S30.
[0107] This embodiment provides a spatial positioning method. Compared with the related art, the ambiguity parameters on two frequency points are usually directly used to search and fix the fixed ambiguity to solve the fixed ambiguity to obtain a high-precision spatial position. However, if the observation value accuracy is poor and it is difficult to fix the ambiguity parameters, it will lead to the inability to obtain accurate positioning information. In this application, when the ambiguity of the current epoch cannot be fixed, the historical fixed ambiguity is obtained, and the historical fixed ambiguity is optimally solved based on the observation equation to determine the fixed solution position of the current epoch. It can be understood that the present application increases the use of historical fixed ambiguity information. When the ambiguity at the current moment is difficult to fix, the historical fixed ambiguity at the same position is used to replace the fixed ambiguity at the current moment, so as to meet the ambiguity requirements of the observation equation. Therefore, the optimal solution of the historical fixed ambiguity based on the observation equation can be obtained to obtain the optimal solution of the current epoch, and then the fixed solution position of the current epoch is determined, and finally high-precision spatial positioning is completed.
[0108] In a feasible implementation manner, the above embodiment may include:
[0109] If the verification value is greater than or equal to a preset verification threshold, the integer ambiguity of the current epoch is obtained;
[0110] Fixing the integer ambiguity of the current epoch to a fixed ambiguity;
[0111] Based on the observation equation, the fixed ambiguity is optimally solved to obtain the optimal position estimation parameters of the current epoch;
[0112] Coordinate parameter extraction is performed on the optimal position estimation parameters to obtain a fixed solution position of the current epoch.
[0113] In a specific implementation, if the ratio value is greater than or equal to the preset threshold, an integer domain search is performed on the floating-point solution ambiguity and the variance-covariance matrix through the LAMBDA search algorithm to obtain the integer ambiguity of the current epoch, and the integer ambiguity of the current epoch is fixed to a fixed ambiguity; based on the observation equation, the fixed ambiguity is optimally solved to obtain the optimal position estimation parameters of the current epoch; coordinate parameters are extracted from the optimal position estimation parameters to obtain a fixed solution position.
[0114] It should be noted that the fixed solution position is a high-precision three-dimensional position coordinate, the integer ambiguity is the integer unknown corresponding to the first observed value of the phase difference between the carrier phase and the reference phase in the carrier phase measurement, and the ratio value is the ratio of the residual quadratic form of the suboptimal integer solution to the residual quadratic form of the optimal integer solution, which characterizes the degree of approximation between the floating-point solution and the optimal integer solution.
[0115] For example, to help understand the implementation process of the spatial positioning method obtained by combining this embodiment with the above-mentioned embodiment 1, please refer to Figure 2 , Figure 2 A brief flowchart of a spatial positioning method is provided, specifically:
[0116] By analyzing RTK filtering, the floating point solution ambiguity and the corresponding equation covariance matrix are obtained;
[0117] Performing integer domain search on the floating point solution ambiguity and the variance-covariance matrix by using a LAMBDA search algorithm to obtain the integer ambiguity, the optimal integer solution and the suboptimal integer solution of the current epoch, and comparing the residual quadratic form of the suboptimal integer solution with the residual quadratic form of the optimal integer solution to obtain a ratio value;
[0118] The ratio value is judged according to a preset threshold value, and if the ratio value is greater than or equal to the preset threshold value, the integer ambiguity of the current epoch is used as the fixed ambiguity, and the fixed ambiguity is calculated to obtain a fixed solution position;
[0119] If the ratio value is less than a preset threshold, the historical fixed ambiguity at the previous moment is obtained, and the historical fixed ambiguity is solved by least squares based on the observation equation to obtain a fixed solution position, wherein the observation equation includes:
[0120] Y=HX+v
[0121] X=(H T H) -1 (Hv)
[0122] Where Y is the sum of the phase observation value and the historical fixed ambiguity, H is the coefficient matrix of the observation vector, v is the observation noise, is the position estimation parameter, x, y, z are the coordinate components in the ECEF coordinate system, and T represents the matrix transpose;
[0123] The phase observation value is obtained by a positioning device, the coefficient matrix is a three-dimensional vector calculated from the phase observation value, and the observation noise is calculated from the altitude angle of the phase observation value.
[0124] It should be noted that the above examples are only used to understand the present application and do not constitute a limitation on the spatial positioning method of the present application. More simple transformations based on this technical concept are all within the scope of protection of the present application.
[0125] This application also provides a spatial positioning device, please refer to Figure 3 , the spatial positioning device comprises:
[0126] An acquisition module 10 is used to obtain floating point ambiguity resolution and variance covariance matrix;
[0127] A search module 20, configured to perform integer domain search on the floating point ambiguity resolution and the variance-covariance matrix to obtain a test value of a current epoch;
[0128] The calculation module 30 is used to obtain the historical fixed ambiguity if the test value is less than a preset test threshold, and to perform optimal solution on the historical fixed ambiguity based on the observation equation to obtain the fixed solution position of the current epoch.
[0129] And / or, the calculation module includes:
[0130] A first acquisition module is used to acquire the historical fixed ambiguity of the previous epoch;
[0131] A first solution module is used to perform optimal solution on the historical fixed ambiguity based on the observation equation to obtain an optimal solution of the position estimation parameter;
[0132] The first extraction module is used to extract coordinate parameters of the optimal solution of the position estimation parameters to obtain a fixed solution position of the current epoch.
[0133] And / or, the first solution module includes:
[0134] A solution module is used to perform a least square solution on the historical fixed ambiguity based on the observation equation to obtain an optimal solution for the position estimation parameter, wherein the observation equation includes:
[0135] Y=HX+v
[0136] X=(H T H) -1 (Hv)
[0137] Where Y is the sum of the phase observation value and the historical fixed ambiguity, H is the coefficient matrix of the observation vector, v is the observation noise, is the position estimation parameter, x, y, z are the coordinate components in the geocentric rectangular coordinate system, and T represents the matrix transpose.
[0138] And / or, the calculation module includes:
[0139] A judgment module, used to judge whether the historical fixed ambiguity of the previous epoch exists;
[0140] A filtering module, configured to obtain the integer ambiguity of the current epoch if the historical fixed ambiguity of the previous epoch does not exist, and to perform filtering constraints on the integer ambiguity based on a filtering algorithm to obtain an optimized integer ambiguity;
[0141] A second solution module is used to perform optimal solution on the optimized integer ambiguity based on the observation equation to obtain the optimal solution of the position estimation parameters of the current epoch;
[0142] The second extraction module is used to extract coordinate parameters of the optimal solution of the position estimation parameters to obtain a fixed solution position of the current epoch.
[0143] And / or, the search module includes:
[0144] A first search module is used to perform integer domain search on the floating point solution ambiguity and the variance covariance matrix through a search algorithm to obtain an optimal integer solution and a suboptimal integer solution;
[0145] A test value module is used to use the ratio of the residual quadratic form of the suboptimal integer solution to the residual quadratic form of the optimal integer solution as the test value of the current epoch.
[0146] And / or, the spatial positioning device comprises:
[0147] A second acquisition module, configured to acquire the integer ambiguity of the current epoch if the verification value is greater than or equal to a preset verification threshold;
[0148] a fixing module, configured to fix the integer ambiguity of the current epoch to a fixed ambiguity; and a third solving module, configured to perform an optimal solution on the fixed ambiguity based on an observation equation to obtain an optimal position estimation parameter of the current epoch;
[0149] The third extraction module is used to extract coordinate parameters of the optimal position estimation parameters to obtain a fixed solution position of the current epoch.
[0150] The spatial positioning device provided by the present application adopts the spatial positioning method in the above embodiment, which can solve the technical problem that high-precision spatial positioning cannot be completed when the ambiguity of the current epoch cannot be fixed. Compared with the prior art, the beneficial effects of the spatial positioning device provided by the present application are the same as the beneficial effects of the spatial positioning method provided by the above embodiment, and the other technical features in the spatial positioning device are the same as the features disclosed in the above embodiment method, which will not be repeated here.
[0151] The present application provides a spatial positioning device, which includes: at least one processor; and a memory communicatively connected to the at least one processor; wherein the memory stores instructions executable by the at least one processor, and the instructions are executed by the at least one processor so that the at least one processor can execute the spatial positioning method in the above-mentioned embodiment one.
[0152] Reference below Figure 4, which shows a schematic diagram of the structure of a spatial positioning device suitable for implementing the embodiment of the present application. The spatial positioning device in the embodiment of the present application may include but is not limited to mobile terminals such as mobile phones, laptop computers, digital broadcast receivers, PDAs (Personal Digital Assistants), PADs (Portable Application Descriptions), PMPs (Portable Media Players), vehicle-mounted terminals (such as vehicle-mounted navigation terminals), etc., and fixed terminals such as digital TVs, desktop computers, etc. Figure 4 The spatial positioning device shown is merely an example and should not bring any limitation to the functions and scope of use of the embodiments of the present application.
[0153] like Figure 4 As shown, the spatial positioning device may include a processing device 1001 (e.g., a central processing unit, a graphics processor, etc.), which can perform various appropriate actions and processes according to a program stored in a read-only memory (ROM: Read Only Memory) 1002 or a program loaded from a storage device 1003 to a random access memory (RAM: Random Access Memory) 1004. In RAM1004, various programs and data required for the operation of the spatial positioning device are also stored. The processing device 1001, ROM1002, and RAM1004 are connected to each other through a bus 1005. An input / output (I / O) interface 1006 is also connected to the bus. Generally, the following systems can be connected to the I / O interface 1006: an input device 1007 including, for example, a touch screen, a touch pad, a keyboard, a mouse, an image sensor, a microphone, an accelerometer, a gyroscope, etc.; an output device 1008 including, for example, a liquid crystal display (LCD: Liquid Crystal Display), a speaker, a vibrator, etc.; a storage device 1003 including, for example, a magnetic tape, a hard disk, etc.; and a communication device 1009. The communication device 1009 can allow the spatial positioning device to communicate with other devices wirelessly or wired to exchange data. Although the figure shows a spatial positioning device with various systems, it should be understood that it is not required to implement or have all the systems shown. More or fewer systems can be implemented or have alternatively.
[0154] In particular, according to the embodiments disclosed in the present application, the process described above with reference to the flowchart can be implemented as a computer software program. For example, the embodiments disclosed in the present application include a computer program product, which includes a computer program carried on a computer-readable medium, and the computer program includes a program code for executing the method shown in the flowchart. In such an embodiment, the computer program can be downloaded and installed from a network through a communication device, or installed from a storage device 1003, or installed from a ROM 1002. When the computer program is executed by the processing device 1001, the above-mentioned functions defined in the method of the embodiment disclosed in the present application are executed.
[0155] The spatial positioning device provided by the present application adopts the spatial positioning method in the above embodiment, which can solve the technical problem that high-precision spatial positioning cannot be completed when the ambiguity of the current epoch cannot be fixed. Compared with the prior art, the beneficial effects of the spatial positioning device provided by the present application are the same as the beneficial effects of the spatial positioning method provided by the above embodiment, and other technical features in the spatial positioning device are the same as the features disclosed in the method of the previous embodiment, which will not be repeated here.
[0156] It should be understood that the various parts disclosed in this application can be implemented by hardware, software, firmware or a combination thereof. In the description of the above embodiments, specific features, structures, materials or characteristics can be combined in any one or more embodiments or examples in a suitable manner.
[0157] The above is only a specific implementation of the present application, but the protection scope of the present application is not limited thereto. Any person skilled in the art who is familiar with the present technical field can easily think of changes or substitutions within the technical scope disclosed in the present application, which should be included in the protection scope of the present application. Therefore, the protection scope of the present application should be based on the protection scope of the claims.
[0158] The present application provides a computer-readable storage medium having computer-readable program instructions (ie, computer programs) stored thereon, wherein the computer-readable program instructions are used to execute the spatial positioning method in the above-mentioned embodiment.
[0159] The computer-readable storage medium provided in the present application may be, for example, a USB flash drive, but is not limited to electrical, magnetic, optical, electromagnetic, infrared, or semiconductor systems, systems or devices, or any combination of the above. More specific examples of computer-readable storage media may include, but are not limited to: an electrical connection with one or more wires, a portable computer disk, a hard disk, a random access memory (RAM), a read-only memory (ROM), an erasable programmable read-only memory (EPROM or flash memory), an optical fiber, a portable compact disk read-only memory (CD-ROM), an optical storage device, a magnetic storage device, or any suitable combination of the above. In this embodiment, the computer-readable storage medium may be any tangible medium containing or storing a program that can be used by or in combination with an instruction execution system, system or device. The program code contained on the computer-readable storage medium may be transmitted using any appropriate medium, including but not limited to: wires, optical cables, RF (Radio Frequency), etc., or any suitable combination of the above.
[0160] The computer-readable storage medium may be included in the spatial positioning device; or may exist independently without being assembled into the spatial positioning device.
[0161] The computer-readable storage medium carries one or more programs. When the one or more programs are executed by the spatial positioning device, the spatial positioning device: obtains floating-point solution ambiguity and variance-covariance matrix; performs integer domain search on the floating-point solution ambiguity and the variance-covariance matrix to obtain a test value of the current epoch; if the test value is less than a preset test threshold, obtains historical fixed ambiguity, performs optimal solution on the historical fixed ambiguity based on the observation equation, and obtains the fixed solution position of the current epoch.
[0162] Computer program code for performing the operations of the present application may be written in one or more programming languages or a combination thereof, including object-oriented programming languages such as Java, Smalltalk, C++, and conventional procedural programming languages such as "C" or similar programming languages. The program code may be executed entirely on the user's computer, partially on the user's computer, as a separate software package, partially on the user's computer and partially on a remote computer, or entirely on a remote computer or server. In the case of a remote computer, the remote computer may be connected to the user's computer through any type of network, including a local area network (LAN) or a wide area network (WAN), or may be connected to an external computer (e.g., via the Internet using an Internet service provider).
[0163] The flow chart and block diagram in the accompanying drawings illustrate the possible architecture, function and operation of the system, method and computer program product according to various embodiments of the present application. In this regard, each square box in the flow chart or block diagram can represent a module, a program segment or a part of a code, and the module, the program segment or a part of the code contains one or more executable instructions for realizing the specified logical function. It should also be noted that in some alternative implementations, the functions marked in the square box can also occur in a sequence different from that marked in the accompanying drawings. For example, two square boxes represented in succession can actually be executed substantially in parallel, and they can sometimes be executed in the opposite order, depending on the functions involved. It should also be noted that each square box in the block diagram and / or flow chart, and the combination of the square boxes in the block diagram and / or flow chart can be implemented with a dedicated hardware-based system that performs a specified function or operation, or can be implemented with a combination of dedicated hardware and computer instructions.
[0164] The modules involved in the embodiments described in this application may be implemented by software or hardware, wherein the name of the module does not constitute a limitation on the unit itself in some cases.
[0165] The readable storage medium provided in the present application is a computer-readable storage medium, which stores computer-readable program instructions (i.e., computer programs) for executing the above-mentioned spatial positioning method, and can solve the technical problem that high-precision spatial positioning cannot be completed when the ambiguity of the current epoch cannot be fixed. Compared with the prior art, the beneficial effects of the computer-readable storage medium provided in the present application are the same as the beneficial effects of the spatial positioning method provided in the above-mentioned embodiment, and will not be repeated here.
[0166] The present application also provides a computer program product, including a computer program, which implements the steps of the above-mentioned spatial positioning method when executed by a processor.
[0167] The computer program product provided by the present application can solve the technical problem that high-precision spatial positioning cannot be completed when the ambiguity of the current epoch cannot be fixed. Compared with the prior art, the beneficial effects of the computer program product provided by the present application are the same as the beneficial effects of the spatial positioning method provided by the above embodiment, which will not be repeated here.
[0168] The above descriptions are only some embodiments of the present application, and are not intended to limit the patent scope of the present application. All equivalent structural changes made using the contents of the present application specification and drawings under the technical concept of the present application, or direct / indirect applications in other related technical fields are included in the patent protection scope of the present application.
Claims
1. A spatial positioning method, It is characterized in that The method includes: Get the floating point ambiguity resolution and variance-covariance matrix of the current epoch; Performing integer domain search on the floating point ambiguity resolution and the variance-covariance matrix to obtain a test value of a current epoch; If the test value is less than a preset test threshold, the historical fixed ambiguity is obtained, and the historical fixed ambiguity is optimally solved based on the observation equation to obtain the fixed solution position of the current epoch.
2. The method according to claim 1, It is characterized in that The step of acquiring historical fixed ambiguities, performing optimal solution calculation on the historical fixed ambiguities based on observation equations, and obtaining the fixed solution position of the current epoch comprises: Get the historical fixed ambiguities of the previous epoch; Based on the observation equation, the historical fixed ambiguity is optimally solved to obtain the optimal solution of the position estimation parameters; Coordinate parameters are extracted for the optimal solution of the position estimation parameters to obtain a fixed solution position of the current epoch.
3. The method according to claim 2, It is characterized in that The step of performing optimal calculation on the historical fixed ambiguity based on the observation equation to obtain the optimal solution of the position estimation parameter comprises: Based on the observation equation, the historical fixed ambiguity is solved by least squares to obtain the optimal solution of the position estimation parameter, wherein the observation equation includes: Y=HX+v X=(H T H) -1 (Hv) Where Y is the sum of the phase observation value and the historical fixed ambiguity, H is the coefficient matrix of the observation vector, v is the observation noise, is the position estimation parameter, x, y, z are the coordinate components in the geocentric rectangular coordinate system, and T represents the matrix transpose.
4. The method according to claim 1, It is characterized in that The step of acquiring historical fixed ambiguities, performing optimal solution calculation on the historical fixed ambiguities based on observation equations, and obtaining the fixed solution position of the current epoch comprises: Determine whether the historical fixed ambiguity of the previous epoch exists; If the historical fixed ambiguity of the previous epoch does not exist, the integer ambiguity of the current epoch is obtained, and based on the filtering algorithm, the integer ambiguity is subjected to filtering constraints to obtain the optimized integer ambiguity; Based on the observation equation, the optimized integer ambiguity is optimally solved to obtain the optimal solution of the position estimation parameters of the current epoch; Coordinate parameters are extracted for the optimal solution of the position estimation parameters to obtain a fixed solution position of the current epoch.
5. The method according to claim 1, It is characterized in that The step of performing integer domain search on the floating point ambiguity resolution and the variance-covariance matrix to obtain a test value of the current epoch comprises: Performing integer domain search on the floating point solution ambiguity and the variance covariance matrix through a search algorithm to obtain an optimal integer solution and a suboptimal integer solution; The ratio of the residual quadratic form of the suboptimal integer solution to the residual quadratic form of the optimal integer solution is used as a test value of the current epoch.
6. The method according to claim 1, It is characterized in that If the test value is less than a preset test threshold, the step of obtaining the historical fixed ambiguity further includes: If the verification value is greater than or equal to a preset verification threshold, the integer ambiguity of the current epoch is obtained; Fixing the integer ambiguity of the current epoch to a fixed ambiguity; Based on the observation equation, the fixed ambiguity is optimally solved to obtain the optimal position estimation parameters of the current epoch; Coordinate parameter extraction is performed on the optimal position estimation parameters to obtain a fixed solution position of the current epoch.
7. A spatial positioning device, It is characterized in that The device comprises: The acquisition module is used to obtain the floating point ambiguity resolution and variance covariance matrix; A search module, configured to perform integer domain search on the floating point ambiguity resolution and the variance-covariance matrix to obtain a test value of a current epoch; A calculation module is used to obtain historical fixed ambiguity if the test value is less than a preset test threshold, and to perform optimal solution on the historical fixed ambiguity based on the observation equation to obtain the fixed solution position of the current epoch.
8. A spatial positioning device, It is characterized in that The device comprises: a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the computer program is configured to implement the steps of the spatial positioning method according to any one of claims 1 to 6.
9. A storage medium, It is characterized in that The storage medium is a computer-readable storage medium, and a computer program is stored on the storage medium. When the computer program is executed by a processor, the steps of the spatial positioning method according to any one of claims 1 to 6 are implemented.
10. A computer program product, It is characterized in that The computer program product comprises a computer program, and when the computer program is executed by a processor, the steps of the spatial positioning method according to any one of claims 1 to 6 are implemented.
Citation Information
Cited By
GNSS partial ambiguity fixing method based on post-test residual sensitivity test
CN122218760A
