[go: up one dir, main page]

CN119738853B - Smartphone positioning method, system, device and medium - Google Patents

Smartphone positioning method, system, device and medium

Info

Publication number
CN119738853B
CN119738853B CN202410540395.8A CN202410540395A CN119738853B CN 119738853 B CN119738853 B CN 119738853B CN 202410540395 A CN202410540395 A CN 202410540395A CN 119738853 B CN119738853 B CN 119738853B
Authority
CN
China
Prior art keywords
smart phone
positioning
data
value
average value
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN202410540395.8A
Other languages
Chinese (zh)
Other versions
CN119738853A (en
Inventor
李婉清
宋江波
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Sun Yat Sen University
Original Assignee
Sun Yat Sen University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Sun Yat Sen University filed Critical Sun Yat Sen University
Priority to CN202410540395.8A priority Critical patent/CN119738853B/en
Publication of CN119738853A publication Critical patent/CN119738853A/en
Application granted granted Critical
Publication of CN119738853B publication Critical patent/CN119738853B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02DCLIMATE CHANGE MITIGATION TECHNOLOGIES IN INFORMATION AND COMMUNICATION TECHNOLOGIES [ICT], I.E. INFORMATION AND COMMUNICATION TECHNOLOGIES AIMING AT THE REDUCTION OF THEIR OWN ENERGY USE
    • Y02D30/00Reducing energy consumption in communication networks
    • Y02D30/70Reducing energy consumption in communication networks in wireless communication networks

Landscapes

  • Position Fixing By Use Of Radio Waves (AREA)

Abstract

The invention discloses a smart phone positioning method, a smart phone positioning system, smart phone positioning equipment and a smart phone positioning medium, and relates to the technical field of Internet of things. And respectively calculating the carrier-to-noise ratio average value and the pseudo-range multipath error average value based on the global navigation satellite system data, and generating the carrier-to-noise ratio average value and the pseudo-range multipath error average value. And carrying out environmental scene recognition according to the carrier-to-noise ratio average value and the pseudo-range multipath error average value. When the scene type is a multipath severe scene, data fusion positioning is carried out by adopting the barometric altimeter data and the global navigation satellite system data according to a tightly combined fusion strategy, so as to generate first positioning data. And when the scene type is an open environment scene, performing data fusion positioning based on the carrier-to-noise ratio average value, the pseudo-range multipath error average value, the barometric altimeter data and the global navigation satellite system data to generate second positioning data. And the data fusion positioning is carried out by adopting the global navigation satellite system data and the barometric altitude data, so that the accuracy and the robustness of acquiring global position information by the smart phone are improved.

Description

Smart phone positioning method, system, equipment and medium
Technical Field
The invention relates to the technical field of Internet of things, in particular to a smart phone positioning method, a smart phone positioning system, smart phone positioning equipment and a smart phone positioning medium.
Background
The smart phone is an important terminal device in smart city and everything interconnection, the high-precision positioning technology based on the smart phone has very wide application market, satellite navigation and position service have important space-time energized functions, so that powerful vitality is provided for digital economic development in China, and great effect is also exerted in daily life production of people.
The smart phone is provided with a plurality of sensors, so that the research on how to use various sensors for fusion positioning on the basis of not changing the original hardware setting has important theoretical and application values. However, the existing smart phone only uses a single sensor to perform positioning, so that the robustness is low, and the satellite navigation elevation measurement is not accurate enough, so that the accuracy of a positioning result is low.
Disclosure of Invention
The invention provides a smart phone positioning method, a system, equipment and a medium, which solve the technical problems that the existing smart phone only uses a single sensor to perform positioning, the robustness is low, the satellite navigation elevation measurement is not accurate enough, and the accuracy of a positioning result is low.
The invention provides a smart phone positioning method, which comprises the following steps:
Acquiring global navigation satellite system data and barometric altitude data acquired by a smart phone, and respectively calculating a carrier-to-noise ratio average value and a pseudo-range multipath error average value based on the global navigation satellite system data to generate the carrier-to-noise ratio average value and the pseudo-range multipath error average value;
performing environment scene recognition according to the carrier-to-noise ratio average value and the pseudo-range multipath error average value, and determining a scene type;
When the scene type is a multipath severe scene, carrying out data fusion positioning by adopting the barometric altimeter data and the global navigation satellite system data according to a tightly combined fusion strategy to generate first positioning data corresponding to the smart phone;
And when the scene type is an open environment scene, performing data fusion positioning based on the carrier-to-noise ratio average value, the pseudo-range multipath error average value, the barometric altimeter data and the global navigation satellite system data to generate second positioning data corresponding to the smart phone.
Optionally, the global navigation satellite system data includes a plurality of satellite signal wavelengths, a plurality of ionospheric errors, a plurality of satellite signal powers, a plurality of bilateral noise power spectral densities, a plurality of pseudo-range values, a plurality of carrier phase values and a plurality of carrier phase ambiguities, and the step of calculating a carrier-to-noise ratio average value and a pseudo-range multipath error average value based on the global navigation satellite system data respectively to generate a carrier-to-noise ratio average value and a pseudo-range multipath error average value includes:
Calculating the ratio between the satellite signal power and the corresponding bilateral noise power spectral density respectively to generate a plurality of carrier-to-noise ratios;
Calculating the sum value among all the carrier-to-noise ratios to generate a carrier-to-noise ratio sum value;
calculating the ratio between the carrier-to-noise ratio sum value and the corresponding carrier-to-noise ratio number to generate a carrier-to-noise ratio average value;
Substituting the satellite signal wavelength, the ionosphere error, the pseudo-range value, the carrier phase value and the carrier phase ambiguity into a preset pseudo-range multipath error expression for calculation to generate a plurality of pseudo-range multipath errors;
the preset pseudo-range multipath error expression is:
;
Wherein, the Is a pseudo-range multipath error; a pseudo-range value observed by the smart phone; A carrier phase value obtained by observing the smart phone; is the satellite signal wavelength; Is an ionospheric error; Is carrier phase ambiguity;
Calculating the sum value among all the pseudo-range multipath errors to generate a pseudo-range multipath error sum value;
and calculating the ratio between the pseudo-range multipath error sum value and the corresponding error quantity, and generating a pseudo-range multipath error average value.
Optionally, the step of identifying the environmental scene according to the average value of the carrier-to-noise ratio and the average value of the multipath error of the pseudo range and determining the scene type includes:
When the average value of the carrier-to-noise ratio is smaller than a first preset value and the average value of the pseudo-range multipath errors is larger than a second preset value, the scene type is a multipath severe scene;
and when the average value of the carrier-to-noise ratio is larger than or equal to the first preset value and the average value of the pseudo-range multipath errors is smaller than the second preset value, the scene type is an open environment scene.
Optionally, when the scene type is a multipath severe scene, performing data fusion positioning by using the barometric altimeter data and the global navigation satellite system data according to a tightly combined fusion policy, and generating first positioning data corresponding to the smart phone, where the step includes:
When the scene type is a multipath severe scene, a quaternary nonlinear equation is constructed by adopting a satellite three-dimensional position, a smart phone three-dimensional position, a pseudo-range observation correction value and a smart phone clock difference in the global navigation satellite system data;
linearizing the quaternary nonlinear equation to generate a linearization positioning matrix equation;
and carrying out iterative solution on the linearization positioning matrix equation by adopting a Newton iteration method, and determining first positioning data corresponding to the smart phone.
Optionally, the step of iteratively solving the linearized positioning matrix equation by using a newton iteration method to determine first positioning data corresponding to the smart phone includes:
Updating the initial smart phone position coordinates and the initial clock difference value corresponding to the linearization positioning matrix equation by adopting a preset updating formula, generating intermediate smart phone position coordinates and intermediate clock difference values, and counting iteration times;
the preset updating formula is as follows:
;
;
Wherein, the The position coordinates of the smart phone after the kth iteration update are obtained; The position coordinates of the smart phone after the k-1 th iteration update are obtained; Representing the three-dimensional position variation in the positioning equation solution; estimating the clock difference of the smart phone for the kth iteration; estimating the clock difference of the smart phone for the k-1 th iteration; The estimated change quantity of the clock difference of the smart phone clock is obtained;
When the iteration times are smaller than or equal to preset iteration times, substituting the position coordinates of the middle intelligent mobile phone and the middle Zhong Chazhi into a preset precision calculation formula to generate a precision value;
The preset precision calculation formula is as follows:
;
wherein A is an accuracy value; representing three-dimensional position change in positioning equation solution, symbol Representing a two-norm function; The estimated change quantity of the clock difference of the smart phone clock is obtained;
When the precision value is smaller than a preset threshold value, the intermediate smart phone position coordinate and the intermediate Zhong Chazhi are used as a target smart phone position coordinate and a target Zhong Chazhi;
Coupling the altitude variation in the barometric altimeter data, the target smart phone position coordinate and the target Zhong Chazhi to a preset positioning equation to carry out least square solution to obtain first positioning data corresponding to the smart phone;
The preset positioning equation is as follows:
;
;
;
Wherein, the Is the coordinate of the geodetic coordinate system and the coordinate of the geodetic coordinate systemH is the third coordinate dimension of the geodetic coordinate system coordinate, called geodetic height; Is the earth dimension; is earth longitude; The estimated change quantity of the clock difference of the smart phone clock is obtained; R is the curvature radius of a mortise unitary circle of a reference ellipsoid, e is the eccentricity of the sphere, a is the long radius of the reference sphere, d is the short radius, and p is an intermediate variable;
and when the precision value is larger than a preset threshold value, taking the intermediate intelligent mobile phone position coordinate and the intermediate Zhong Chazhi as a new initial intelligent mobile phone position coordinate and a new initial Zhong Chazhi, skipping to execute the steps of updating the initial intelligent mobile phone position coordinate and the initial clock difference value corresponding to the linearization positioning matrix equation by adopting a preset updating formula, generating an intermediate intelligent mobile phone position coordinate and an intermediate clock difference value, and counting the iteration times.
Optionally, the step of generating the second positioning data corresponding to the smart phone based on the carrier-to-noise ratio average value, the pseudo-range multipath error average value, the barometric altimeter data and the global navigation satellite system data for data fusion positioning includes:
When the pseudo-range multipath error average value is smaller than a third preset value and the carrier-to-noise ratio average value is larger than or equal to a fourth preset value, carrying out data fusion positioning by adopting the barometric altimeter data and the global navigation satellite system data according to a loose combination fusion strategy to generate first three-dimensional positioning data corresponding to the smart phone;
And when the pseudo-range multipath error average value is in a first preset interval and the carrier-to-noise ratio average value is in a second preset interval, carrying out data fusion positioning by adopting the barometric altimeter data and the global navigation satellite system data according to the tight combination fusion strategy, and generating second three-dimensional positioning data corresponding to the smart phone.
Optionally, the step of performing data fusion positioning by using the barometric altimeter data and the global navigation satellite system data according to a loose combination fusion policy to generate first three-dimensional positioning data corresponding to the smart phone includes:
Inputting the barometric altimeter data and the global navigation satellite system data into a preset Kalman filtering model to perform state variable estimation, and generating an estimated state vector;
substituting the gain matrix, the measurement matrix and the estimated state vector corresponding to the estimated state vector into a preset state variable estimation formula, and calculating to obtain a Kalman filtering state quantity estimated value;
The preset state variable estimation formula is as follows:
;
Wherein, the The state quantity estimation value is Kalman filtering state quantity estimation value; is an estimated state vector from time f-1 to time f; Is a gain matrix; Is a measurement matrix; For measuring the matrix, the expression is set as ;
Subtracting the initial altitude data in the Kalman filtering state quantity estimation value from the altitude data in the global navigation satellite system data to generate target altitude data;
and updating coordinate data corresponding to the Kalman filtering state quantity estimation value by adopting the target height data to generate first three-dimensional positioning data corresponding to the smart phone.
The invention also provides a smart phone positioning system, which comprises:
the average value generation module is used for acquiring global navigation satellite system data and barometric altitude data acquired by the smart phone, respectively calculating a carrier-to-noise ratio average value and a pseudo-range multipath error average value based on the global navigation satellite system data, and generating the carrier-to-noise ratio average value and the pseudo-range multipath error average value;
the scene type determining module is used for carrying out environment scene recognition according to the carrier-to-noise ratio average value and the pseudo-range multipath error average value and determining the scene type;
The first positioning data generation module is used for carrying out data fusion positioning by adopting the barometric altimeter data and the global navigation satellite system data according to a tight combination fusion strategy when the scene type is a multipath severe scene, so as to generate first positioning data corresponding to the smart phone;
And the second positioning data generation module is used for carrying out data fusion positioning based on the carrier-to-noise ratio average value, the pseudo-range multipath error average value, the barometric altimeter data and the global navigation satellite system data when the scene type is an open environment scene, and generating second positioning data corresponding to the smart phone.
The invention also provides an electronic device comprising a memory and a processor, wherein the memory stores a computer program, and the computer program when executed by the processor causes the processor to execute the steps for realizing the positioning method of any one of the smart phones.
The present invention also provides a computer readable storage medium having stored thereon a computer program which when executed implements a smartphone positioning method as any one of the above.
From the above technical scheme, the invention has the following advantages:
According to the invention, the carrier-to-noise ratio average value and the pseudo-range multipath error average value are respectively calculated based on the global navigation satellite system data by acquiring the global navigation satellite system data and the barometric altitude data acquired by the smart phone, so that the carrier-to-noise ratio average value and the pseudo-range multipath error average value are generated. And carrying out environmental scene recognition based on the carrier-to-noise ratio average value and the pseudo-range multipath error average value, and determining the scene type. When the scene type is a multipath severe scene, data fusion positioning is carried out by adopting the barometric altimeter data and the global navigation satellite system data according to a tightly combined fusion strategy, so as to generate first positioning data corresponding to the smart phone. And when the scene type is an open environment scene, carrying out data fusion positioning based on the carrier-to-noise ratio average value, the pseudo-range multipath error average value, the barometric altimeter data and the global navigation satellite system data, and generating second positioning data corresponding to the smart phone. The intelligent mobile phone positioning method and system based on the sensor detection solves the technical problems that an existing intelligent mobile phone only uses a single sensor to perform positioning robustness is low, satellite navigation elevation measurement is not accurate enough, and positioning result accuracy is low. The global navigation satellite system data and the barometric altitude data are adopted for data fusion positioning, so that the accuracy and the robustness of acquiring global position information by the smart phone are improved, and the accuracy of an obtained positioning result is high.
Drawings
In order to more clearly illustrate the embodiments of the invention or the technical solutions of the prior art, the drawings which are used in the description of the embodiments or the prior art will be briefly described, it being obvious that the drawings in the description below are only some embodiments of the invention, and that other drawings can be obtained from these drawings without inventive faculty for a person skilled in the art.
Fig. 1 is a flowchart of steps of a smart phone positioning method according to a first embodiment of the present invention;
fig. 2 is a flowchart of steps of a smart phone positioning method according to a second embodiment of the present invention;
fig. 3 is a block diagram of a smart phone positioning system according to a third embodiment of the present invention;
fig. 4 is a block diagram of an electronic device according to a fourth embodiment of the present invention.
Detailed Description
The embodiment of the invention provides a smart phone positioning method, a system, equipment and a medium, which are used for solving the technical problems that the positioning robustness of the existing smart phone is low by only using a single sensor, and the satellite navigation elevation measurement is not accurate enough, so that the accuracy of a positioning result is low.
In order to make the objects, features and advantages of the present invention more comprehensible, the technical solutions in the embodiments of the present invention are described in detail below with reference to the accompanying drawings, and it is apparent that the embodiments described below are only some embodiments of the present invention, but not all embodiments of the present invention. All other embodiments, which can be made by those skilled in the art based on the embodiments of the invention without making any inventive effort, are intended to be within the scope of the invention.
Referring to fig. 1, fig. 1 is a flowchart illustrating steps of a smart phone positioning method according to an embodiment of the invention.
The first embodiment of the invention provides a smart phone positioning method, which comprises the following steps:
Step 101, acquiring global navigation satellite system data and barometric altitude data acquired by a smart phone, and respectively calculating a carrier-to-noise ratio average value and a pseudo-range multipath error average value based on the global navigation satellite system data to generate the carrier-to-noise ratio average value and the pseudo-range multipath error average value.
In the embodiment of the invention, the smart phone is provided with two sensors of a Global Navigation Satellite System (GNSS) and an barometer altimeter (PS). And acquiring global navigation satellite system data and barometric altitude data acquired by the smart phone. The global navigation satellite system data includes a plurality of satellite signal wavelengths, a plurality of ionospheric errors, a plurality of satellite signal powers, a plurality of bilateral noise power spectral densities, a plurality of pseudo-range values, a plurality of carrier phase ambiguities, and the like, which are used for realizing positioning calculation. And respectively calculating the ratio between the satellite signal power and the corresponding bilateral noise power spectral density to obtain a plurality of carrier-to-noise ratios. And calculating the sum value among all the carrier-to-noise ratios, and generating the carrier-to-noise ratio sum value. And calculating the ratio between the sum of the carrier-to-noise ratios and the corresponding carrier-to-noise ratio number, and generating a carrier-to-noise ratio average value. And substituting the satellite signal wavelength, the ionosphere error, the pseudo-range value, the carrier phase value and the carrier phase ambiguity into a preset pseudo-range multipath error expression for calculation to generate a plurality of pseudo-range multipath errors. And calculating the sum value among all the pseudo-range multipath errors, and generating the sum value of the pseudo-range multipath errors. And calculating the ratio between the sum value of the pseudo-range multipath errors and the corresponding error quantity, and generating a pseudo-range multipath error average value.
And 102, carrying out environmental scene recognition according to the carrier-to-noise ratio average value and the pseudo-range multipath error average value, and determining the scene type.
In the embodiment of the invention, the carrier-to-noise ratio average value and the pseudo-range multipath error average value are respectively compared with a first preset value and a second preset value. When the average value of the carrier-to-noise ratio is smaller than a first preset value and the average value of the pseudo-range multipath errors is larger than a second preset value, the scene type is a multipath serious scene. When the average value of the carrier-to-noise ratio is larger than or equal to a first preset value and the average value of the pseudo-range multipath errors is smaller than a second preset value, the scene type is an open environment scene.
And 103, when the scene type is a multipath severe scene, carrying out data fusion positioning by adopting the barometric altimeter data and the global navigation satellite system data according to a tightly combined fusion strategy, and generating first positioning data corresponding to the smart phone.
In the embodiment of the invention, when the scene type is a multipath severe scene, a quaternary nonlinear equation is constructed by adopting a satellite three-dimensional position, a smart phone three-dimensional position, a pseudo-range observation correction value and a smart phone clock difference in global navigation satellite system data. And linearizing the quaternary nonlinear equation to generate a linearization positioning matrix equation. And carrying out iterative solution on the linear positioning matrix equation by adopting a Newton iteration method, and determining first positioning data corresponding to the smart phone.
And 104, when the scene type is an open environment scene, performing data fusion positioning based on the carrier-to-noise ratio average value, the pseudo-range multipath error average value, the barometric altimeter data and the global navigation satellite system data to generate second positioning data corresponding to the smart phone.
In the embodiment of the invention, when the average value of the pseudo-range multipath errors is smaller than a third preset value and the average value of the carrier-to-noise ratio is larger than or equal to a fourth preset value, data fusion positioning is performed by adopting the barometric altimeter data and the global navigation satellite system data according to a loose combination fusion strategy, and first three-dimensional positioning data corresponding to the smart phone is generated. When the pseudo-range multipath error average value is in a first preset interval and the carrier-to-noise ratio average value is in a second preset interval, carrying out data fusion positioning by adopting the barometric altimeter data and the global navigation satellite system data according to a tight combination fusion strategy, and generating second three-dimensional positioning data corresponding to the smart phone.
In the embodiment of the invention, the carrier-to-noise ratio average value and the pseudo-range multipath error average value are generated by acquiring the global navigation satellite system data and the barometric altitude data acquired by the smart phone and respectively calculating the carrier-to-noise ratio average value and the pseudo-range multipath error average value based on the global navigation satellite system data. And carrying out environmental scene recognition based on the carrier-to-noise ratio average value and the pseudo-range multipath error average value, and determining the scene type. When the scene type is a multipath severe scene, data fusion positioning is carried out by adopting the barometric altimeter data and the global navigation satellite system data according to a tightly combined fusion strategy, so as to generate first positioning data corresponding to the smart phone. And when the scene type is an open environment scene, carrying out data fusion positioning based on the carrier-to-noise ratio average value, the pseudo-range multipath error average value, the barometric altimeter data and the global navigation satellite system data, and generating second positioning data corresponding to the smart phone. The intelligent mobile phone positioning method and system based on the sensor detection solves the technical problems that an existing intelligent mobile phone only uses a single sensor to perform positioning robustness is low, satellite navigation elevation measurement is not accurate enough, and positioning result accuracy is low. The global navigation satellite system data and the barometric altitude data are adopted for data fusion positioning, so that the accuracy and the robustness of acquiring global position information by the smart phone are improved, and the accuracy of an obtained positioning result is high.
Referring to fig. 2, fig. 2 is a flowchart illustrating steps of a smart phone positioning method according to a second embodiment of the present invention.
The second embodiment of the invention provides another smart phone positioning method, which comprises the following steps:
Step 201, acquiring global navigation satellite system data and barometric altitude data acquired by a smart phone, and respectively calculating a carrier-to-noise ratio average value and a pseudo-range multipath error average value based on the global navigation satellite system data to generate the carrier-to-noise ratio average value and the pseudo-range multipath error average value.
Further, the global navigation satellite system data includes a plurality of satellite signal wavelengths, a plurality of ionospheric errors, a plurality of satellite signal powers, a plurality of bilateral noise power spectral densities, a plurality of pseudorange values, a plurality of carrier phase values, and a plurality of carrier phase ambiguities. Step 201 may include the following sub-steps S11-S16:
S11, calculating the ratio between the satellite signal power and the corresponding bilateral noise power spectral density respectively, and generating a plurality of carrier-to-noise ratios.
S12, calculating the sum value among all the carrier-to-noise ratios, and generating the carrier-to-noise ratio sum value.
S13, calculating the ratio between the carrier-to-noise ratio sum value and the corresponding carrier-to-noise ratio number, and generating a carrier-to-noise ratio average value.
S14, substituting the satellite signal wavelength, the ionosphere error, the pseudo-range value, the carrier phase value and the carrier phase ambiguity into a preset pseudo-range multipath error expression for calculation to generate a plurality of pseudo-range multipath errors.
S15, calculating the sum value of all the pseudo-range multipath errors, and generating the pseudo-range multipath error sum value.
S16, calculating the ratio between the sum value of the pseudo-range multipath errors and the corresponding error quantity, and generating a pseudo-range multipath error average value.
In the embodiment of the invention, the carrier-to-noise ratio is the original observed quantity obtained after the GNSS chip processes the signals. The pseudorange multipath error may be calculated using the code subtracted phase as a combination. The specific calculation process is as follows:
The carrier to noise ratio expression is:
;
Wherein, the The unit is dB-Hz for carrier-to-noise ratio; Is satellite signal power; Is a bilateral noise power spectral density.
The preset pseudo-range multipath error expression is:
;
Wherein, the Is a pseudo-range multipath error; a pseudo-range value observed by the smart phone; A carrier phase value obtained by observing the smart phone; is the satellite signal wavelength; Is an ionospheric error; For carrier phase ambiguity, it can be solved by the LAMBDA algorithm or regarded as a constant in the static case, then This constant is eliminated after the running average process.
And respectively calculating the ratio between the satellite signal power and the corresponding bilateral noise power spectral density through the carrier-to-noise ratio expression to obtain a plurality of carrier-to-noise ratios. And then calculating the sum value among all the carrier-to-noise ratios to obtain the carrier-to-noise ratio sum value. And finally, calculating the ratio between the sum of the carrier-to-noise ratios and the corresponding carrier-to-noise ratio number to obtain the average value of the carrier-to-noise ratios. And substituting the satellite signal wavelength, the ionosphere error, the pseudo range value, the carrier phase value and the carrier phase ambiguity acquired by the smart phone into a preset pseudo range multipath error expression, and calculating to obtain a plurality of pseudo range multipath errors. And then obtaining the sum value of the pseudo-range multipath errors by calculating the sum value among all the pseudo-range multipath errors. And finally, calculating the ratio between the sum of the pseudo-range multipath errors and the corresponding error quantity to obtain the average value of the pseudo-range multipath errors.
And 202, carrying out environmental scene recognition according to the average value of the carrier-to-noise ratio and the average value of the pseudo-range multipath error, and determining the scene type.
Further, step 202 may comprise the following sub-steps S21-S22:
S21, when the average value of the carrier-to-noise ratio is smaller than a first preset value and the average value of the pseudo-range multipath errors is larger than a second preset value, the scene type is a multipath serious scene.
S22, when the average value of the carrier-to-noise ratio is larger than or equal to a first preset value and the average value of the pseudo-range multipath errors is smaller than a second preset value, the scene type is an open environment scene.
The first preset value is 30dB-Hz. The second preset value is 5m.
In the embodiment of the invention, the scenes where the smart phone is positioned are classified into severe multipath scenes and open environment scenes according to the carrier-to-noise ratio and the pseudo-range multipath errors. The method specifically comprises the step of calculating a carrier-to-noise ratio average value smaller than 30dB-Hz and a pseudo-range multipath error average value larger than 5m, wherein the scene type corresponding to the smart phone is a multipath severe scene. When the average value of the calculated carrier-to-noise ratio is larger than or equal to 30dB-Hz and the average value of the pseudo-range multipath errors is smaller than 5m, the scene type corresponding to the intelligent mobile phone is an open environment scene.
And 203, when the scene type is a multipath severe scene, constructing a quaternary nonlinear equation by adopting a satellite three-dimensional position, a smart phone three-dimensional position, a pseudo-range observation correction value and a smart phone clock difference in the global navigation satellite system data.
In the embodiment of the invention, different fusion strategies are adopted in different scenes. The fusion strategy is divided into a loose combination fusion strategy and a tight combination fusion strategy. The tight combination fusion strategy is applicable to multipath severe scenes and open environment scenes, while the loose combination fusion strategy is applicable to open environment scenes. And adopting tightly combined data fusion in a multipath severe scene. The tightly combined fusion strategy is to fuse the altitude information of the altimeter into a GNSS positioning algorithm by utilizing the characteristic of high accuracy of the altitude of the altimeter, and the tightly combined fusion strategy comprises the following specific contents:
Obtaining a relation between the following positions and distances according to the position relation, namely adopting a satellite three-dimensional position, a smart phone three-dimensional position, a pseudo-range observation correction value and a smart phone clock difference in global navigation satellite system data to construct a quaternary nonlinear equation, wherein the quaternary nonlinear equation is as follows:
;
Wherein, the The three-dimensional position of the nth satellite, n represents the nth satellite observed by the smart phone,Is the temporary number of satellites or satellite measurements; The satellite three-dimensional position of the 1 st satellite; The satellite three-dimensional position of the 2 nd satellite; The satellite three-dimensional position of the nth satellite; The three-dimensional position of the smart phone; clock error for the smart phone; is the temporary number of satellites or satellite measurements; A modified pseudorange observation for satellite 1; a pseudo-range observation value corrected for the 2 nd satellite; And the corrected pseudo-range observation value is obtained by deducting satellite clock errors (which are sent to the mobile phone to be stored in a navigation message file by satellites), ionosphere errors (estimated by using a Klobuchar model) and troposphere errors (estimated by using a Saastamoinen model) from the pseudo-range observation value obtained by processing a GNSS chip in the smart phone.
And 204, linearizing the quaternary nonlinear equation to generate a linearization positioning matrix equation.
In the embodiment of the invention, the four-element nonlinear equation is linearized to obtain a linearized positioning matrix equation, wherein the linearized positioning matrix equation is as follows:
;
;
;
wherein the geometric matrix G is a jacobian matrix and is related only to the geometric position of each satellite relative to the smartphone; In (a) and (b) The method is characterized in that the method is the coordinate variation of the smart phone under a geocentric and geodetic fixed coordinate system in three directions of the position xyz between two adjacent observation moments; B is a residual matrix, r is the distance from the smart phone to the satellite; k represents the number of newton iterations in progress for the current epoch, i.e., k-1 is the number of iterations that have been completed for the current epoch, and k=1 represents the first iteration; distance from the Nth smart phone to satellite Bias to x inA value at; Is that Bias to y atA value at; Is that Deflection to z inA value at; Is that ;Is thatPosition coordinates of the smart phone; a pseudo-range observation value corrected for an nth satellite; geometric distance from the receiver to the nth satellite; the estimated smartphone clock skew for the k-1 th iteration.
And 205, carrying out iterative solution on the linearized positioning matrix equation by adopting a Newton iteration method, and determining first positioning data corresponding to the smart phone.
In the embodiment of the invention, linearization is needed to solve the quaternary nonlinear equation, so that the linearized positioning matrix equation is obtained. And in order to obtain a solution, calculating by adopting a Newton iteration method to obtain a positioning equation solution of a positioning linearization positioning matrix equation.
Further, step 205 may include the following substeps S31-S35:
and S31, updating the initial smart phone position coordinates and the initial clock difference value corresponding to the linearized positioning matrix equation by adopting a preset updating formula, generating intermediate smart phone position coordinates and intermediate clock difference values, and counting the iteration times.
S32, substituting the position coordinates of the middle intelligent mobile phone and the middle clock difference value into a preset precision calculation formula to generate a precision value when the iteration times are smaller than or equal to the preset iteration times.
And S33, when the precision value is smaller than a preset threshold value, taking the middle intelligent mobile phone position coordinate and the middle Zhong Chazhi as the target intelligent mobile phone position coordinate and the target clock difference value.
And S34, coupling the altitude variation in the barometric altimeter data, the target smart phone position coordinates and the target Zhong Chazhi into a preset positioning equation to carry out least square solution, and obtaining first positioning data corresponding to the smart phone.
And S35, when the precision value is larger than a preset threshold value, taking the middle intelligent mobile phone position coordinate and the middle Zhong Chazhi as a new initial intelligent mobile phone position coordinate and a new initial Zhong Chazhi, skipping to execute the steps of updating the initial intelligent mobile phone position coordinate and the initial clock difference value corresponding to the linearization positioning matrix equation by adopting a preset updating formula, generating a middle intelligent mobile phone position coordinate and a middle clock difference value, and counting the iteration times.
In the embodiment of the invention, pseudo ranges, satellite clock differences and satellite positions of all satellites acquired by a GNSS chip in the smart phone relative to the smart phone are used as inputs, wherein the coordinate variation and the clock difference variation are solutions in Newton iterative calculation, and finally the obtained solutions are three-dimensional position coordinates of the smart phone, the clock differences of the smart phone, namely the position coordinates of the target smart phone and the target clock difference. The specific solving process is as follows:
given an initial value ,For a given initial value of the smartphone location,For a given smartphone clock difference initial value. For the kth solving, the positioning equation obtained by solving the iterative format based on the Newton iteration method is solved as follows:
;
wherein the geometric matrix G is a jacobian matrix and is related only to the geometric position of each satellite relative to the smartphone; Is that Is to be used in the present invention,Representing the inverse of the matrix; the method is characterized in that the method is the coordinate variation of the smart phone under a geocentric and geodetic fixed coordinate system in three directions of the position xyz between two adjacent observation moments (two adjacent iterations); Coordinates of the smart phone under a geocentric fixed coordinate system in the kth iteration; coordinates of the smart phone under a geocentric fixed coordinate system in the k-1 iteration; The estimated change quantity of the clock difference of the smart phone clock is obtained; estimating the clock difference of the smart phone for the kth iteration; estimating the clock difference of the smart phone for the k-1 th iteration; b is the residual matrix.
Height variation added to barometric altimeter data, user's height variationHeight variation by barometric altimeterTo show that, by means of the method,
Therefore, after the height variation is added, the positioning equation innovated by the invention, namely the preset positioning equation is obtained as follows:
;
Wherein, the The estimated change quantity of the clock difference of the smart phone clock is obtained; is the height variation; Is the coordinate of the geodetic coordinate system and the coordinate of the geodetic coordinate system Correspondingly, a certain conversion relation exists, and the conversion formula is as follows:
;
;
Wherein R is the curvature radius of a mortise unitary circle of a reference ellipsoid, e is the eccentricity of the sphere, a is the long radius of the reference sphere, d is the short radius, p is the intermediate variable without special meaning, and h is the coordinate of a geodetic coordinate system And the third dimensional coordinates of (c) represent the ground level,Is the earth dimension; Is geodetic.
Carrying out iterative solution through a linearization positioning matrix equation and a preset positioning equation to obtain a final solution result, namely obtaining a solutionAt this point the altitude data has been added to the positioning equation for positioning resolution.
Updating the initial smart phone position coordinate and the initial clock difference value corresponding to the linearization positioning matrix equation by adopting a preset updating formula, generating an intermediate smart phone position coordinate and an intermediate clock difference value, and counting the iteration times to obtain the smart phone position coordinate after the following k iteration updatingAnd the clock difference valueNamely, the preset updating formula is as follows:
;
;
Wherein, the The position coordinates of the smart phone after the kth iteration update are obtained; The position coordinates of the smart phone after the k-1 th iteration update are obtained; Representing the three-dimensional position variation in the positioning equation solution; estimating the clock difference of the smart phone for the kth iteration; estimating the clock difference of the smart phone for the k-1 th iteration; and (5) the estimated change amount of the clock skew of the smart phone.
And substituting the position coordinates of the middle intelligent mobile phone and the middle clock difference value into a preset precision calculation formula to generate a precision value when the iteration times are smaller than or equal to the preset iteration times. The preset accuracy calculation formula, namely the accuracy requirement judgment basis isWhereinRepresenting three-dimensional position change in positioning equation solution, symbolRepresenting a function of the two norms,And the clock error of the smart phone is calculated in the solution of the positioning equation. JudgingIf the position coordinate of the middle smart phone is smaller than the preset threshold value, the solution meets the precision requirement, and the position coordinate of the middle smart phone and the middle Zhong Chazhi are used as the position coordinate of the target smart phone and the difference value of the target clock. And coupling the altitude variation in the barometric altimeter data, the target smart phone position coordinate and the target Zhong Chazhi to a preset positioning equation to solve least square, so as to obtain first positioning data corresponding to the smart phone. Otherwise, continuing iteration, namely taking the position coordinates of the middle smart phone and the middle Zhong Chazhi as new initial smart phone position coordinates and new initial Zhong Chazhi, jumping to execute the steps of updating the initial smart phone position coordinates and the initial clock difference value corresponding to the linearization positioning matrix equation by adopting a preset updating formula, generating the difference value between the position coordinates of the middle smart phone and the middle clock, and counting the iteration times. And when the iteration times exceed the preset iteration times, the position calculation fails.
And if the updated solution meets the precision requirement, solving to obtain the high-precision position information of the intelligent mobile phone. If the solution does not meet the precision requirement,The newton's iterative operation described above may be continued as a starting point for the (k+1) th iteration. And acquiring GNSS original data pseudo-range observed quantity under a tight combination fusion strategy to perform pseudo-range positioning, coupling altimeter height data into a positioning equation to perform least square solution, and finally obtaining a three-dimensional positioning result.
And 206, when the scene type is an open environment scene, performing data fusion positioning based on the carrier-to-noise ratio average value, the pseudo-range multipath error average value, the barometric altimeter data and the global navigation satellite system data, and generating second positioning data corresponding to the smart phone.
Further, step 206 may include the following substeps S41-S42:
s41, when the average value of the pseudo-range multipath errors is smaller than a third preset value and the average value of the carrier-to-noise ratio is larger than or equal to a fourth preset value, performing data fusion positioning by adopting the barometric altimeter data and the global navigation satellite system data according to a loose combination fusion strategy, and generating first three-dimensional positioning data corresponding to the smart phone.
S42, when the pseudo-range multipath error average value is in a first preset interval and the carrier-to-noise ratio average value is in a second preset interval, carrying out data fusion positioning by adopting the barometric altimeter data and the global navigation satellite system data according to a tightly combined fusion strategy, and generating second three-dimensional positioning data corresponding to the smart phone.
Further, step S41 may comprise the following sub-steps S411-S414:
S411, inputting the barometric altimeter data and the global navigation satellite system data into a preset Kalman filtering model to perform state variable estimation, and generating an estimated state vector.
S412, substituting the gain matrix, the measurement matrix and the estimated state vector corresponding to the estimated state vector into a preset state variable estimation formula, and calculating to obtain the Kalman filtering state quantity estimated value.
S413, subtracting the initial altitude data in the Kalman filtering state quantity estimation value from the altitude data in the global navigation satellite system data to generate target altitude data.
And S414, updating coordinate data corresponding to the Kalman filtering state quantity estimation value by adopting the target height data to generate first three-dimensional positioning data corresponding to the smart phone.
The third preset value is 3m. The fourth preset value is 35dB-Hz. The first preset interval is 3m or less, and the average value of the pseudo-range multipath errors is 5m or less. The second preset interval is 35dB-Hz, the average value of the carrier-to-noise ratio is more than or equal to 30dB-Hz.
In the embodiment of the invention, when the average value of the pseudo-range multipath errors is smaller than 3m and the average value of the carrier-to-noise ratio is larger than or equal to 35dB-Hz, a loose combination fusion strategy is adopted to conduct data fusion positioning to generate second positioning data corresponding to the smart phone, otherwise, when the average value of the pseudo-range multipath errors is smaller than or equal to 3m and is smaller than or equal to 5m and the average value of the carrier-to-noise ratio is larger than or equal to 35dB-Hz, data fusion positioning is conducted according to the tight combination fusion strategy to generate second positioning data corresponding to the smart phone. The central idea of the loose combination fusion strategy is to utilize the calculated height data of the barometric pressure altitude to directly carry out Kalman filtering with the height data in the GNSS three-dimensional position, so as to realize the fusion of the multi-source data.
The following describes a loose combination fusion strategy, i.e. a filter estimation algorithm flow for altitude data fusion of GNSS, barometric altimeters, wherein the rate of change of GNSS positioning data, altitude data is a component in state variables, and other matrices are other variations of these state variables. The GNSS sensor outputs three-dimensional position coordinate data asThe altitude data of the output data of the barometric altimeter PS is that
Based on the Kalman filter model, the state equation and the measurement equation can be expressed as:
;
Wherein, the For the state variable matrix of time f, set;Setting a one-step transfer matrix from time f-1 to time f as an identity matrix; for the measurement matrix, set as ;For measuring the matrix, the expression is set as;A system noise matrix is time f-1; the noise matrix is measured for time f.
It is generally assumed that,For zero-mean Gaussian white noise which is uncorrelated with each other, the following conditions are satisfied:
;
Wherein, the Representing a time f system noise matrix; representing a time f measurement noise matrix; A covariance matrix of system noise; transpose of the noise matrix for the time j system; measuring a transpose of the noise matrix for time j; covariance matrix for measuring noise; is a Kronecker (Kronecker) function. If the system noise covariance matrix Non-negative definite matrix, measurement noise covariance matrixIs a positive definite matrix, the one-step state prediction equation is:
;
Wherein, the The estimated state vector from time f-1 to time f is the state variable estimated by the Kalman filterThe state variable is set by the three-dimensional position variable quantity corresponding to the mobile phone positioning data;An estimated state vector for time k-1; Is a one-step transition matrix from time f-1 to time f.
The one-step estimation error covariance matrix equation is:
;
Wherein, the Estimating an error covariance matrix for one step from time f to time f-1; An estimated error covariance matrix at the time f-1; one-step transfer matrix for time f to time f-1 Is a transpose of (2); the system noise variance matrix at the time f-1; driving a matrix for system noise Is a transpose of (a).
The gain matrix expression is:
;
Wherein, the Is a gain matrix; for measuring matrix Is a transpose of (2); Estimating an error covariance matrix for one step from time f to time f-1; Is the covariance matrix of the measured noise.
Covariance matrix estimation:
;
Wherein, the Estimating an error covariance matrix for one step of time f; For measuring the matrix, the expression is set as ;Estimating an error covariance matrix for one step from time f to time f-1; is a unit matrix; covariance matrix for measuring noise; is a gain matrix Is a transpose of (a).
The preset state variable estimation formula is:
;
Wherein, the The state quantity estimation value is Kalman filtering state quantity estimation value; The estimated state vector from time f-1 to time f is the state variable estimated by the Kalman filter The state variable is set by the three-dimensional position variable quantity corresponding to the mobile phone positioning data;Is a gain matrix; for the measurement matrix, set as ,Altitude data in the global navigation satellite system data; altitude data in the barometric altimeter data; For measuring the matrix, the expression is set as
And inputting the barometric altimeter data and the global navigation satellite system data into a preset Kalman filtering model to perform state variable estimation to obtain an estimated state vector. And substituting the gain matrix, the measurement matrix and the estimated state vector corresponding to the estimated state vector into a preset state variable estimation formula, and calculating to obtain the Kalman filtering state quantity estimated value. Altitude data in the global navigation satellite system data in the GNSS three-dimensional position is then used for determining the altitude of the GPS dataSubtracting Kalman filtering state quantity estimation valueFinally, a fusion positioning result is obtained. Namely, the initial altitude data in the Kalman filtering state quantity estimation value is subtracted from the altitude data in the global navigation satellite system data to generate target altitude data. And updating coordinate data corresponding to the Kalman filtering state quantity estimation value by adopting the target height data to generate first three-dimensional positioning data corresponding to the smart phone.
In the embodiment of the invention, the data fusion algorithm of two sensors of a Global Navigation Satellite System (GNSS) and an barometer (PS) is combined to improve the accuracy and the robustness of acquiring global position information by the smart phone. The data fusion strategy can be expanded from a satellite navigation and air pressure altimeter to a multi-sensor fusion mode such as satellite navigation and inertial navigation and air pressure altimeter, satellite navigation and inertial navigation and visual navigation and air pressure altimeter and the like. And adding related variables of an Inertial Navigation System (INS), such as position errors, speed errors and the like, into the state variables, and then estimating the errors by Kalman filtering to obtain accurate positions, thereby realizing a data loose combination strategy of satellite navigation, inertial navigation and barometric altimeter. Position errors, speed errors and the like of the visual navigation system are added into the state variables, so that a satellite navigation, inertial navigation, visual navigation and air pressure altitude count loose combination strategy is realized.
Referring to fig. 3, fig. 3 is a block diagram illustrating a positioning system of a smart phone according to a third embodiment of the present invention.
The third embodiment of the invention provides a smart phone positioning system, which comprises:
the average value generating module 301 is configured to obtain global navigation satellite system data and barometric altitude data collected by the smart phone, and calculate a carrier-to-noise ratio average value and a pseudo-range multipath error average value based on the global navigation satellite system data, respectively, to generate the carrier-to-noise ratio average value and the pseudo-range multipath error average value.
The scene type determining module 302 is configured to perform environmental scene recognition according to the average value of the carrier-to-noise ratio and the average value of the pseudo-range multipath error, and determine the scene type.
The first positioning data generating module 303 is configured to perform data fusion positioning by using the barometric altimeter data and the global navigation satellite system data according to a tightly combined fusion policy when the scene type is a multipath severe scene, and generate first positioning data corresponding to the smart phone.
And the second positioning data generating module 304 is configured to perform data fusion positioning based on the carrier-to-noise ratio average value, the pseudo-range multipath error average value, the barometric altimeter data and the global navigation satellite system data when the scene type is an open environment scene, and generate second positioning data corresponding to the smart phone.
Optionally, the global navigation satellite system data includes a plurality of satellite signal wavelengths, a plurality of ionospheric errors, a plurality of satellite signal powers, a plurality of bilateral noise power spectral densities, a plurality of pseudorange values, a plurality of carrier phase values, and a plurality of carrier phase ambiguities. The average value generation module 301 may perform the following steps:
calculating the ratio between the satellite signal power and the corresponding bilateral noise power spectral density respectively to generate a plurality of carrier-to-noise ratios;
calculating the sum value among all the carrier-to-noise ratios, and generating a carrier-to-noise ratio sum value;
Calculating the ratio between the sum of the carrier-to-noise ratios and the corresponding carrier-to-noise ratio number to generate a carrier-to-noise ratio average value;
Substituting the satellite signal wavelength, the ionosphere error, the pseudo-range value, the carrier phase value and the carrier phase ambiguity into a preset pseudo-range multipath error expression for calculation to generate a plurality of pseudo-range multipath errors;
The preset pseudo-range multipath error expression is:
;
Wherein, the Is a pseudo-range multipath error; a pseudo-range value observed by the smart phone; A carrier phase value obtained by observing the smart phone; is the satellite signal wavelength; Is an ionospheric error; Is carrier phase ambiguity;
calculating the sum value among all pseudo-range multipath errors to generate a pseudo-range multipath error sum value;
and calculating the ratio between the sum value of the pseudo-range multipath errors and the corresponding error quantity, and generating a pseudo-range multipath error average value.
Alternatively, the scene type determination module 302 may perform the following steps:
When the average value of the carrier-to-noise ratio is smaller than a first preset value and the average value of the pseudo-range multipath errors is larger than a second preset value, the scene type is a multipath serious scene;
When the average value of the carrier-to-noise ratio is larger than or equal to a first preset value and the average value of the pseudo-range multipath errors is smaller than a second preset value, the scene type is an open environment scene.
Optionally, the first positioning data generating module 303 includes:
The quaternary nonlinear equation construction module is used for constructing a quaternary nonlinear equation by adopting the satellite three-dimensional position, the smart phone three-dimensional position, the pseudo-range observation correction value and the smart phone clock difference in the global navigation satellite system data when the scene type is a multipath severe scene.
And the linearization positioning matrix equation generation module is used for linearizing the quaternary nonlinear equation to generate a linearization positioning matrix equation.
And the first positioning data generation sub-module is used for carrying out iterative solution on the linearization positioning matrix equation by adopting a Newton iteration method and determining the first positioning data corresponding to the smart phone.
Alternatively, the first positioning data generation sub-module may perform the steps of:
updating the initial smart phone position coordinates and the initial clock difference value corresponding to the linearization positioning matrix equation by adopting a preset updating formula, generating intermediate smart phone position coordinates and intermediate clock difference values, and counting iteration times;
the preset updating formula is as follows:
;
;
Wherein, the The position coordinates of the smart phone after the kth iteration update are obtained; The position coordinates of the smart phone after the k-1 th iteration update are obtained; Representing the three-dimensional position variation in the positioning equation solution; estimating the clock difference of the smart phone for the kth iteration; estimating the clock difference of the smart phone for the k-1 th iteration; The estimated change quantity of the clock difference of the smart phone clock is obtained;
substituting the position coordinates of the middle intelligent mobile phone and the middle clock difference value into a preset precision calculation formula to generate a precision value when the iteration times are smaller than or equal to the preset iteration times;
the preset precision calculation formula is as follows:
;
wherein A is an accuracy value; representing three-dimensional position change in positioning equation solution, symbol Representing a two-norm function; The estimated change quantity of the clock difference of the smart phone clock is obtained;
When the precision value is smaller than a preset threshold value, taking the middle intelligent mobile phone position coordinate and the middle Zhong Chazhi as the target intelligent mobile phone position coordinate and the target Zhong Chazhi;
coupling the altitude variation in the barometric altimeter data, the target smart phone position coordinate and the target Zhong Chazhi into a preset positioning equation to carry out least square solution to obtain first positioning data corresponding to the smart phone;
The preset positioning equation is:
;
;
;
Wherein, the Is the coordinate of the geodetic coordinate system and the coordinate of the geodetic coordinate systemH is the third coordinate dimension of the geodetic coordinate system coordinate, called geodetic height; Is the earth dimension; is earth longitude; The estimated change quantity of the clock difference of the smart phone clock is obtained; R is the curvature radius of a mortise unitary circle of a reference ellipsoid, e is the eccentricity of the sphere, a is the long radius of the reference sphere, d is the short radius, and p is an intermediate variable;
And when the precision value is larger than a preset threshold value, taking the position coordinates of the middle smart phone and the middle Zhong Chazhi as new initial smart phone position coordinates and new initial Zhong Chazhi, skipping to execute the steps of updating the initial smart phone position coordinates and the initial clock difference value corresponding to the linearization positioning matrix equation by adopting a preset updating formula, generating the position coordinates of the middle smart phone and the middle clock difference value, and counting the iteration times.
Optionally, the second positioning data generating module 304 includes:
And the first three-dimensional positioning data generation module is used for carrying out data fusion positioning by adopting the barometric altimeter data and the global navigation satellite system data according to a loose combination fusion strategy when the average value of the pseudo-range multipath errors is smaller than a third preset value and the average value of the carrier-to-noise ratio is larger than or equal to a fourth preset value, so as to generate first three-dimensional positioning data corresponding to the smart phone.
And the second three-dimensional positioning data generation module is used for carrying out data fusion positioning by adopting the barometric altimeter data and the global navigation satellite system data according to a tightly combined fusion strategy when the pseudo-range multipath error average value is in a first preset interval and the carrier-to-noise ratio average value is in a second preset interval, so as to generate second three-dimensional positioning data corresponding to the smart phone.
Alternatively, the first three-dimensional positioning data generation module may perform the steps of:
inputting barometric altimeter data and global navigation satellite system data into a preset Kalman filtering model to perform state variable estimation, and generating an estimated state vector;
Substituting a gain matrix, a measurement matrix and an estimated state vector corresponding to the estimated state vector into a preset state variable estimation formula, and calculating to obtain a Kalman filtering state quantity estimated value;
The preset state variable estimation formula is:
;
Wherein, the The state quantity estimation value is Kalman filtering state quantity estimation value; is an estimated state vector from time f-1 to time f; Is a gain matrix; Is a measurement matrix; For measuring the matrix, the expression is set as ;
Subtracting the initial altitude data in the Kalman filtering state quantity estimation value from the altitude data in the global navigation satellite system data to generate target altitude data;
And updating coordinate data corresponding to the Kalman filtering state quantity estimation value by adopting the target height data to generate first three-dimensional positioning data corresponding to the smart phone.
Referring to fig. 4, fig. 4 is a block diagram of an electronic device according to a third embodiment of the present invention.
The electronic device of the embodiment of the invention comprises a memory 401 and a processor 402, wherein the memory 401 stores a computer program, and the computer program when executed by the processor 402 causes the processor 402 to execute the smart phone positioning method according to any of the embodiments.
The memory 401 may be an electronic memory such as a flash memory, an EEPROM (electrically erasable programmable read only memory), an EPROM, a hard disk, or a ROM. Memory 401 has storage space 403 for program code 413 for performing any of the method steps described above. For example, the memory space 403 for program code may include individual program code 413 for implementing the various steps in the above method, respectively. The program code can be read from or written to one or more computer program products. These computer program products comprise a program code carrier such as a hard disk, a Compact Disc (CD), a memory card or a floppy disk. The program code may be compressed, for example, in a suitable form. The codes, when executed by a computing processing device, cause the computing processing device to perform the steps in the smartphone positioning method described above.
The embodiment of the invention also provides a computer readable storage medium, on which a computer program is stored, which when executed by a processor, implements the smart phone positioning method according to any of the above embodiments.
It will be clear to those skilled in the art that, for convenience and brevity of description, specific working procedures of the above-described systems, apparatuses and units may refer to corresponding procedures in the foregoing method embodiments, which are not repeated herein.
In the several embodiments provided in the present application, it should be understood that the disclosed systems, devices, and methods may be implemented in other manners. For example, the apparatus embodiments described above are merely illustrative, e.g., the division of elements is merely a logical functional division, and there may be additional divisions of actual implementation, e.g., multiple elements or components may be combined or integrated into another system, or some features may be omitted, or not performed. Alternatively, the coupling or direct coupling or communication connection shown or discussed with each other may be an indirect coupling or communication connection via some interfaces, devices or units, which may be in electrical, mechanical or other form.
The units described as separate units may or may not be physically separate, and units shown as units may or may not be physical units, may be located in one place, or may be distributed over a plurality of network units. Some or all of the units may be selected according to actual needs to achieve the purpose of the solution of this embodiment.
In addition, each functional unit in the embodiments of the present invention may be integrated in one processing unit, or each unit may exist alone physically, or two or more units may be integrated in one unit. The integrated units may be implemented in hardware or in software functional units.
The integrated units, if implemented in the form of software functional units and sold or used as stand-alone products, may be stored in a computer readable storage medium. Based on such understanding, the technical solution of the present invention may be embodied in essence or a part contributing to the prior art or all or part of the technical solution in the form of a software product stored in a storage medium, including several instructions for causing a computer device (which may be a personal computer, a server, or a network device, etc.) to perform all or part of the steps of the methods of the embodiments of the present invention. The storage medium includes a U disk, a removable hard disk, a Read-Only Memory (ROM), a random access Memory (RAM, random Access Memory), a magnetic disk, an optical disk, or other various media capable of storing program codes.
The foregoing embodiments are merely for illustrating the technical solution of the present invention, but not for limiting the same, and although the present invention has been described in detail with reference to the foregoing embodiments, it will be understood by those skilled in the art that modifications may be made to the technical solution described in the foregoing embodiments or equivalents may be substituted for parts of the technical features thereof, and that such modifications or substitutions do not depart from the spirit and scope of the technical solution of the embodiments of the present invention in essence.

Claims (8)

1. The smart phone positioning method is characterized by comprising the following steps of:
Acquiring global navigation satellite system data and barometric altitude data acquired by a smart phone, and respectively calculating a carrier-to-noise ratio average value and a pseudo-range multipath error average value based on the global navigation satellite system data to generate the carrier-to-noise ratio average value and the pseudo-range multipath error average value;
performing environment scene recognition according to the carrier-to-noise ratio average value and the pseudo-range multipath error average value, and determining a scene type;
When the scene type is a multipath severe scene, carrying out data fusion positioning by adopting the barometric altimeter data and the global navigation satellite system data according to a tightly combined fusion strategy to generate first positioning data corresponding to the smart phone;
When the scene type is an open environment scene, performing data fusion positioning based on the carrier-to-noise ratio average value, the pseudo-range multipath error average value, the barometric altimeter data and the global navigation satellite system data to generate second positioning data corresponding to the smart phone;
When the scene type is a multipath severe scene, performing data fusion positioning by adopting the barometric altimeter data and the global navigation satellite system data according to a tightly combined fusion strategy, and generating first positioning data corresponding to the smart phone, wherein the method comprises the following steps of:
When the scene type is a multipath severe scene, a quaternary nonlinear equation is constructed by adopting a satellite three-dimensional position, a smart phone three-dimensional position, a pseudo-range observation correction value and a smart phone clock difference in the global navigation satellite system data;
linearizing the quaternary nonlinear equation to generate a linearization positioning matrix equation;
Carrying out iterative solution on the linearization positioning matrix equation by adopting a Newton iteration method, and determining first positioning data corresponding to the smart phone;
The step of iteratively solving the linearized positioning matrix equation by adopting a newton iteration method to determine first positioning data corresponding to the smart phone comprises the following steps:
Updating the initial smart phone position coordinates and the initial clock difference value corresponding to the linearization positioning matrix equation by adopting a preset updating formula, generating intermediate smart phone position coordinates and intermediate clock difference values, and counting iteration times;
the preset updating formula is as follows:
;
;
Wherein, the The position coordinates of the smart phone after the kth iteration update are obtained; The position coordinates of the smart phone after the k-1 th iteration update are obtained; Representing the three-dimensional position variation in the positioning equation solution; estimating the clock difference of the smart phone for the kth iteration; estimating the clock difference of the smart phone for the k-1 th iteration; The estimated change quantity of the clock difference of the smart phone clock is obtained;
When the iteration times are smaller than or equal to preset iteration times, substituting the position coordinates of the middle intelligent mobile phone and the middle Zhong Chazhi into a preset precision calculation formula to generate a precision value;
The preset precision calculation formula is as follows:
;
wherein A is an accuracy value; representing three-dimensional position change in positioning equation solution, symbol Representing a two-norm function; The estimated change quantity of the clock difference of the smart phone clock is obtained;
When the precision value is smaller than a preset threshold value, the intermediate smart phone position coordinate and the intermediate Zhong Chazhi are used as a target smart phone position coordinate and a target Zhong Chazhi;
Coupling the altitude variation in the barometric altimeter data, the target smart phone position coordinate and the target Zhong Chazhi to a preset positioning equation to carry out least square solution to obtain first positioning data corresponding to the smart phone;
The preset positioning equation is as follows:
;
;
;
Wherein, the Is the coordinate of the geodetic coordinate system and the coordinate of the geodetic coordinate systemH is the third coordinate dimension of the geodetic coordinate system coordinate, called geodetic height; Is the earth dimension; is earth longitude; The estimated change quantity of the clock difference of the smart phone clock is obtained; R is the curvature radius of a mortise unitary circle of a reference ellipsoid, e is the eccentricity of the sphere, a is the long radius of the reference sphere, d is the short radius, and p is an intermediate variable;
and when the precision value is larger than a preset threshold value, taking the intermediate intelligent mobile phone position coordinate and the intermediate Zhong Chazhi as a new initial intelligent mobile phone position coordinate and a new initial Zhong Chazhi, skipping to execute the steps of updating the initial intelligent mobile phone position coordinate and the initial clock difference value corresponding to the linearization positioning matrix equation by adopting a preset updating formula, generating an intermediate intelligent mobile phone position coordinate and an intermediate clock difference value, and counting the iteration times.
2. The method of claim 1, wherein the global navigation satellite system data includes a plurality of satellite signal wavelengths, a plurality of ionospheric errors, a plurality of satellite signal powers, a plurality of bilateral noise power spectral densities, a plurality of pseudorange values, a plurality of carrier phase values, and a plurality of carrier phase ambiguities, and wherein the steps of calculating a carrier-to-noise ratio average and a pseudorange multipath error average based on the global navigation satellite system data, respectively, and generating a carrier-to-noise ratio average and a pseudorange multipath error average comprise:
Calculating the ratio between the satellite signal power and the corresponding bilateral noise power spectral density respectively to generate a plurality of carrier-to-noise ratios;
Calculating the sum value among all the carrier-to-noise ratios to generate a carrier-to-noise ratio sum value;
calculating the ratio between the carrier-to-noise ratio sum value and the corresponding carrier-to-noise ratio number to generate a carrier-to-noise ratio average value;
Substituting the satellite signal wavelength, the ionosphere error, the pseudo-range value, the carrier phase value and the carrier phase ambiguity into a preset pseudo-range multipath error expression for calculation to generate a plurality of pseudo-range multipath errors;
the preset pseudo-range multipath error expression is:
;
Wherein, the Is a pseudo-range multipath error; a pseudo-range value observed by the smart phone; A carrier phase value obtained by observing the smart phone; is the satellite signal wavelength; Is an ionospheric error; Is carrier phase ambiguity;
Calculating the sum value among all the pseudo-range multipath errors to generate a pseudo-range multipath error sum value;
and calculating the ratio between the pseudo-range multipath error sum value and the corresponding error quantity, and generating a pseudo-range multipath error average value.
3. The smart phone positioning method according to claim 1, wherein the step of identifying an environmental scene and determining a scene type according to the carrier-to-noise ratio average value and the pseudo-range multipath error average value includes:
When the average value of the carrier-to-noise ratio is smaller than a first preset value and the average value of the pseudo-range multipath errors is larger than a second preset value, the scene type is a multipath severe scene;
and when the average value of the carrier-to-noise ratio is larger than or equal to the first preset value and the average value of the pseudo-range multipath errors is smaller than the second preset value, the scene type is an open environment scene.
4. The method for positioning a smart phone according to claim 1, wherein the step of generating second positioning data corresponding to the smart phone based on the carrier-to-noise ratio average value, the pseudo-range multipath error average value, the barometric altimeter data and the global navigation satellite system data by performing data fusion positioning includes:
When the pseudo-range multipath error average value is smaller than a third preset value and the carrier-to-noise ratio average value is larger than or equal to a fourth preset value, carrying out data fusion positioning by adopting the barometric altimeter data and the global navigation satellite system data according to a loose combination fusion strategy to generate first three-dimensional positioning data corresponding to the smart phone;
And when the pseudo-range multipath error average value is in a first preset interval and the carrier-to-noise ratio average value is in a second preset interval, carrying out data fusion positioning by adopting the barometric altimeter data and the global navigation satellite system data according to the tight combination fusion strategy, and generating second three-dimensional positioning data corresponding to the smart phone.
5. The method for positioning a smart phone according to claim 4, wherein the step of performing data fusion positioning by using the barometric altimeter data and the global navigation satellite system data according to a loose combination fusion policy to generate first three-dimensional positioning data corresponding to the smart phone comprises the following steps:
Inputting the barometric altimeter data and the global navigation satellite system data into a preset Kalman filtering model to perform state variable estimation, and generating an estimated state vector;
substituting the gain matrix, the measurement matrix and the estimated state vector corresponding to the estimated state vector into a preset state variable estimation formula, and calculating to obtain a Kalman filtering state quantity estimated value;
The preset state variable estimation formula is as follows:
;
Wherein, the The state quantity estimation value is Kalman filtering state quantity estimation value; is an estimated state vector from time f-1 to time f; Is a gain matrix; Is a measurement matrix; For measuring the matrix, the expression is set as ;
Subtracting the initial altitude data in the Kalman filtering state quantity estimation value from the altitude data in the global navigation satellite system data to generate target altitude data;
and updating coordinate data corresponding to the Kalman filtering state quantity estimation value by adopting the target height data to generate first three-dimensional positioning data corresponding to the smart phone.
6. A smartphone positioning system, comprising:
the average value generation module is used for acquiring global navigation satellite system data and barometric altitude data acquired by the smart phone, respectively calculating a carrier-to-noise ratio average value and a pseudo-range multipath error average value based on the global navigation satellite system data, and generating the carrier-to-noise ratio average value and the pseudo-range multipath error average value;
the scene type determining module is used for carrying out environment scene recognition according to the carrier-to-noise ratio average value and the pseudo-range multipath error average value and determining the scene type;
The first positioning data generation module is used for carrying out data fusion positioning by adopting the barometric altimeter data and the global navigation satellite system data according to a tight combination fusion strategy when the scene type is a multipath severe scene, so as to generate first positioning data corresponding to the smart phone;
The second positioning data generation module is used for carrying out data fusion positioning based on the carrier-to-noise ratio average value, the pseudo-range multipath error average value, the barometric altimeter data and the global navigation satellite system data when the scene type is an open environment scene, and generating second positioning data corresponding to the smart phone;
The first positioning data generating module includes:
the quaternary nonlinear equation construction module is used for constructing a quaternary nonlinear equation by adopting a satellite three-dimensional position, a smart phone three-dimensional position, a pseudo-range observation correction value and a smart phone clock difference in the global navigation satellite system data when the scene type is a multipath severe scene;
The linearization positioning matrix equation generation module is used for linearizing the quaternary nonlinear equation to generate a linearization positioning matrix equation;
the first positioning data generation sub-module is used for carrying out iterative solution on the linearization positioning matrix equation by adopting a Newton iteration method and determining first positioning data corresponding to the smart phone;
The first positioning data generating submodule is specifically configured to perform the following steps:
Updating the initial smart phone position coordinates and the initial clock difference value corresponding to the linearization positioning matrix equation by adopting a preset updating formula, generating intermediate smart phone position coordinates and intermediate clock difference values, and counting iteration times;
the preset updating formula is as follows:
;
;
Wherein, the The position coordinates of the smart phone after the kth iteration update are obtained; The position coordinates of the smart phone after the k-1 th iteration update are obtained; Representing the three-dimensional position variation in the positioning equation solution; estimating the clock difference of the smart phone for the kth iteration; estimating the clock difference of the smart phone for the k-1 th iteration; The estimated change quantity of the clock difference of the smart phone clock is obtained;
When the iteration times are smaller than or equal to preset iteration times, substituting the position coordinates of the middle intelligent mobile phone and the middle Zhong Chazhi into a preset precision calculation formula to generate a precision value;
The preset precision calculation formula is as follows:
;
wherein A is an accuracy value; representing three-dimensional position change in positioning equation solution, symbol Representing a two-norm function; The estimated change quantity of the clock difference of the smart phone clock is obtained;
When the precision value is smaller than a preset threshold value, the intermediate smart phone position coordinate and the intermediate Zhong Chazhi are used as a target smart phone position coordinate and a target Zhong Chazhi;
Coupling the altitude variation in the barometric altimeter data, the target smart phone position coordinate and the target Zhong Chazhi to a preset positioning equation to carry out least square solution to obtain first positioning data corresponding to the smart phone;
The preset positioning equation is as follows:
;
;
;
Wherein, the Is the coordinate of the geodetic coordinate system and the coordinate of the geodetic coordinate systemH is the third coordinate dimension of the geodetic coordinate system coordinate, called geodetic height; Is the earth dimension; is earth longitude; The estimated change quantity of the clock difference of the smart phone clock is obtained; R is the curvature radius of a mortise unitary circle of a reference ellipsoid, e is the eccentricity of the sphere, a is the long radius of the reference sphere, d is the short radius, and p is an intermediate variable;
and when the precision value is larger than a preset threshold value, taking the intermediate intelligent mobile phone position coordinate and the intermediate Zhong Chazhi as a new initial intelligent mobile phone position coordinate and a new initial Zhong Chazhi, skipping to execute the steps of updating the initial intelligent mobile phone position coordinate and the initial clock difference value corresponding to the linearization positioning matrix equation by adopting a preset updating formula, generating an intermediate intelligent mobile phone position coordinate and an intermediate clock difference value, and counting the iteration times.
7. An electronic device comprising a memory and a processor, the memory storing a computer program that, when executed by the processor, causes the processor to perform the steps of the smartphone positioning method of any one of claims 1 to 5.
8. A computer readable storage medium, on which a computer program is stored, characterized in that the computer program, when executed, implements the smartphone positioning method according to any one of claims 1 to 5.
CN202410540395.8A 2024-04-30 2024-04-30 Smartphone positioning method, system, device and medium Active CN119738853B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202410540395.8A CN119738853B (en) 2024-04-30 2024-04-30 Smartphone positioning method, system, device and medium

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202410540395.8A CN119738853B (en) 2024-04-30 2024-04-30 Smartphone positioning method, system, device and medium

Publications (2)

Publication Number Publication Date
CN119738853A CN119738853A (en) 2025-04-01
CN119738853B true CN119738853B (en) 2025-10-24

Family

ID=95129142

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202410540395.8A Active CN119738853B (en) 2024-04-30 2024-04-30 Smartphone positioning method, system, device and medium

Country Status (1)

Country Link
CN (1) CN119738853B (en)

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5109706B2 (en) * 2007-04-23 2012-12-26 セイコーエプソン株式会社 Positioning method and positioning device
CN107064974A (en) * 2017-02-28 2017-08-18 广东工业大学 A kind of localization method and system for suppressing urban canyons multipath satellite-signal
KR102808742B1 (en) * 2020-05-18 2025-05-21 한국전자통신연구원 Gnss positioning system
CN114779297B (en) * 2022-01-10 2025-02-25 北京邮电大学 Terminal positioning method and related device
CN114545475B (en) * 2022-01-14 2025-07-04 南京航空航天大学 A multi-source integrated navigation and positioning method in complex environments

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
An adaptive frequency-based C/N0-constrained multipath extraction and mitigation method for GNSS pseudorange measurements;Liu, Ruofan et al;《MEASUREMENT SCIENCE AND TECHNOLOGY》;20240605;第35卷(第9期);1-12 *
Exploring Multipath Mitigation Mechanism of Circular Smartphone Antenna Motion With C/N0 and Multipath Frequency;Li, Wanqing et al;《 IEEE TRANSACTIONS ON INSTRUMENTATION AND MEASUREMENT》;20240508;第73卷;1-11 *

Also Published As

Publication number Publication date
CN119738853A (en) 2025-04-01

Similar Documents

Publication Publication Date Title
CN114502987B (en) System and method for GNSS correction generation for Gaussian process augmentation
US20240142637A1 (en) System and method for gaussian process enhanced gnss corrections generation
CN109477900A (en) Estimation of Inter-Frequency Bias for Ambiguity Resolution in GNSS Receivers
CN112907671B (en) Point cloud data generation method and device, electronic equipment and storage medium
Waserman et al. A mixed-integer least-squares formulation of the GNSS snapshot positioning problem
Siemuri et al. Improving precision GNSS positioning and navigation accuracy on smartphones using machine learning
Batstone et al. Robust time-of-arrival self calibration with missing data and outliers
Stein et al. Handling uncertainties in image mining for remote sensing studies
JP5039063B2 (en) How to track the status of a portable electronic device
CN117724139A (en) A method to maintain high-precision positioning in continuous motion in complex environments
CN119738853B (en) Smartphone positioning method, system, device and medium
CN119805517A (en) A positioning method, device and storage medium based on low-orbit satellite opportunity signal
CN114608569B (en) Three-dimensional pose estimation method, system, computer equipment and storage medium
CN119043336A (en) Method, apparatus, medium and program product for fusing baseline calculation with IMU data
CN118426010A (en) Fixed verification method and device, electronic equipment and storage medium
CN113917509B (en) Double-difference ambiguity fixing method, device and readable storage medium
CN116973961A (en) Target object positioning method, device, computer equipment and fuzziness update method
CN108427127A (en) The test method and device of baseband chip performance
JP7407325B1 (en) Water depth information processing device, flood analysis support device, and water depth information processing method
CN112698368A (en) Navigation signal analysis method of navigation receiver and computer storage readable medium
Ahmadi et al. Robust Multi-Sensor Fusion Positioning Based on GNSS/IMU Using Factor Graph Optimization
Delenne et al. Endorheic waterbodies delineation from remote sensing as a tool for immersed surface topography
CN120176733B (en) Satellite signal source optimal point correction positioning method, device, equipment and storage medium
CN114035219B (en) A positioning method and electronic device in the absence of GPS signal
CN112698374B (en) BDS-3/magnetometer-based multi-frequency double-antenna vehicle-mounted attitude measurement method and equipment

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant