Indoor positioning method and device, server, storage medium and program
By obtaining the TDOA and carrier phase observations of mobile terminals, reference terminals and wireless access points, calculating the differential and double-difference measurements, and iteratively solves the problem of low indoor positioning accuracy and poor real-time performance. Achieve high-precision indoor fast positioning.
Patent Information
- Application Number
- CN202410909129.8
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-08
- Publication Date
- 2024-12-06
AI Technical Summary
The existing indoor positioning technology has shortcomings in accuracy and real-time performance, especially RFID, ultra-wideband, ultrasonic and radar positioning technologies require additional facilities to be deployed and costly, while the positioning accuracy based on cellular mobile communications can only reach the meter level.
By obtaining the TDOA and carrier phase observations of mobile terminals and reference terminals and wireless access points, calculating the difference and double-difference measurements, eliminating the clock difference, and using the carrier phase double-difference measurements to perform iterative solution of the whole week at multiple time points, we realize High-precision indoor positioning.
It improves the accuracy and real-time performance of indoor positioning, solves the current problems of low indoor positioning accuracy and poor real-time performance, and achieves high-precision fast positioning.
Smart Images

Figure CN119094985A_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the field of intelligent connected vehicle technology, and in particular to an indoor positioning method, device, server, storage medium and program. Background Art
[0002] With the improvement of the research and development level and innovation ability of Internet of Things technology, indoor positioning has a good development momentum and its applications are constantly expanding.
[0003] Among the related technologies, the mainstream indoor positioning technologies mainly include radio frequency identification positioning technology, ultra-wideband positioning technology, ultrasonic positioning technology and radar positioning technology. In addition, with the help of cellular mobile communication systems, positioning technologies based on arrival time, arrival time difference, arrival angle and received signal strength, as well as positioning technologies based on carrier phase are also used for indoor positioning.
[0004] However, radio frequency identification positioning technology, ultra-wideband positioning technology, ultrasonic positioning technology and radar positioning technology have been applied in specific environments, but they often require the deployment of additional facilities, resulting in high construction costs. With the help of cellular mobile communication systems, positioning technologies based on arrival time, arrival time difference, arrival angle and received signal strength do not require the deployment of additional facilities, but the positioning accuracy is not high and can only reach the meter level. Summary of the invention
[0005] The present application provides an indoor positioning method, device, server, storage medium and program to solve the current problems of low indoor positioning accuracy and poor real-time performance.
[0006] The first aspect of the present application provides an indoor positioning method, comprising the following steps: obtaining TDOA observation values and carrier phase observation values of a mobile terminal and a reference terminal respectively with all wireless access points; calculating TDOA differential measurement values based on the TDOA observation values of the mobile terminal and the reference terminal respectively with all wireless access points, and calculating carrier phase single-difference measurement values based on the carrier phase observation values of the mobile terminal and the reference terminal respectively with all wireless access points; calculating the TDOA observation value of the mobile terminal after eliminating the clock error based on the position of the reference terminal and the TDOA differential measurement value, and determining a coarse positioning result of the mobile terminal based on the TDOA observation value of the mobile terminal after eliminating the clock error; determining a carrier phase double-difference measurement value of the mobile terminal after eliminating the clock error based on the carrier phase single-difference measurement value of the mobile terminal and the reference terminal respectively, and determining a final positioning result of the mobile terminal based on the coarse positioning result and the carrier phase double-difference measurement value.
[0007] Optionally, in an embodiment of the present application, a final positioning result of the mobile terminal is determined based on the coarse positioning result and the carrier phase double difference measurement value, including: confirming the double difference equation based on the carrier phase double difference measurement value; performing integer iterative solution of the double difference equation at multiple time points based on the coarse positioning result to obtain an integer ambiguity floating solution; calculating the distance difference between the mobile terminal and each wireless access point based on the integer ambiguity floating solution; and locating the position of the mobile terminal based on the distance difference between the mobile terminal and each wireless access point.
[0008] Optionally, in an embodiment of the present application, the double difference equation is iteratively solved at multiple time points according to the coarse positioning result to obtain a floating solution for the integer ambiguity, including: performing an initial linearization on the double difference equation with the coarse positioning result as the initial Taylor expansion point; solving the initially linearized double difference equation to obtain a solution result, wherein the solution result includes the integer ambiguity and the position coordinates of the mobile terminal at multiple time points; starting from the solution result of the initially linearized double difference equation, the double difference equation is linearized based on the solution result of the current round of iteration, until the solution result of the current round of iteration converges to obtain a floating solution for the integer ambiguity.
[0009] Optionally, in an embodiment of the present application, during each round of iteration, a phase-locked loop or a frequency-locked loop is set not to lose lock at multiple time points, and a target element of the double difference equation is updated.
[0010] Optionally, in an embodiment of the present application, the double difference equation is:
[0011]
[0012] in, is the distance difference, λ is the wavelength of the wireless signal, is the double difference integer ambiguity, is the double difference measurement error.
[0013] Optionally, in the embodiment of the present application, the distance difference is calculated as follows:
[0014]
[0015] in, is the phase of the carrier phase signal from the wireless access point numbered i observed by the mobile terminal s at time t, is the phase of the carrier phase signal from the wireless access point numbered i observed by the reference terminal r at time t, λ is the wavelength of the wireless signal, is the double difference integer ambiguity, is a known quantity.
[0016] A second aspect of the present application provides an indoor positioning device, including: an acquisition module, used to acquire TDOA observation values and carrier phase observation values of a mobile terminal and a reference terminal respectively with all wireless access points; a calculation module, used to calculate TDOA differential measurement values based on the TDOA observation values of the mobile terminal and the reference terminal respectively with all wireless access points, and calculate carrier phase single-difference measurement values based on the carrier phase observation values of the mobile terminal and the reference terminal respectively with all wireless access points; a determination module, used to calculate the TDOA observation value of the mobile terminal after eliminating the clock error based on the position of the reference terminal and the TDOA differential measurement value, and determine the coarse positioning result of the mobile terminal based on the TDOA observation value of the mobile terminal after eliminating the clock error; a positioning module, used to determine the carrier phase double-difference measurement value of the mobile terminal after eliminating the clock error based on the carrier phase single-difference measurement value of the mobile terminal and the reference terminal respectively, and determine the final positioning result of the mobile terminal based on the coarse positioning result and the carrier phase double-difference measurement value.
[0017] Optionally, in an embodiment of the present application, the positioning module also includes: determining a double difference equation based on a carrier phase double difference measurement value; performing integer iterative solutions on the double difference equation at multiple time points based on the coarse positioning result to obtain an integer ambiguity floating solution; calculating the distance difference between the mobile terminal and each wireless access point based on the integer ambiguity floating solution; and locating the position of the mobile terminal based on the distance difference between the mobile terminal and each wireless access point.
[0018] Optionally, in an embodiment of the present application, the positioning module also includes: performing an initial linearization on the double difference equation using the coarse positioning result as the initial Taylor expansion point; solving the initially linearized double difference equation to obtain a solution result, wherein the solution result includes the integer ambiguity and the position coordinates of the mobile terminal at multiple time points; starting from the solution result of the initially linearized double difference equation, linearizing the double difference equation based on the solution result of the current round of iteration until the solution result of the current round of iteration converges to obtain a floating solution for the integer ambiguity.
[0019] Optionally, in an embodiment of the present application, during each round of iteration, a phase-locked loop or a frequency-locked loop is set not to lose lock at multiple time points, and a target element of the double difference equation is updated.
[0020] Optionally, in an embodiment of the present application, the double difference equation is:
[0021]
[0022] in, is the distance difference, λ is the wavelength of the wireless signal, is the double-difference integer ambiguity, is the double difference measurement error.
[0023] Optionally, in the embodiment of the present application, the distance difference is calculated as follows:
[0024]
[0025] in, is the phase of the carrier phase signal from the wireless access point numbered i observed by the mobile terminal s at time t, is the phase of the carrier phase signal from the wireless access point numbered i observed by the reference terminal r at time t, λ is the wavelength of the wireless signal, is the double-difference integer ambiguity, is a known quantity.
[0026] The third aspect of the present application provides a server, including: a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor executes the program to implement the indoor positioning method as described in the above embodiment.
[0027] The fourth aspect of the present application provides a computer-readable storage medium on which a computer program is stored. The computer program is executed by a processor to implement the indoor positioning method as described in the above embodiment.
[0028] The fifth aspect of the present application provides a computer program product, including a computer program or instructions. When the computer program or instructions are executed, they are used to implement the indoor positioning method as described in the above embodiment.
[0029] Therefore, this application has at least the following beneficial effects:
[0030] The embodiment of the present application obtains the TDOA observation values and carrier phase observation values of the mobile terminal and the reference terminal respectively with all wireless access points; calculates the TDOA differential measurement value according to the above TDOA observation value, and calculates the carrier phase single difference measurement value according to the carrier phase observation value; calculates the TDOA observation value of the mobile terminal after eliminating the clock error according to the position of the reference terminal and the TDOA differential measurement value, thereby determining the rough positioning result of the mobile terminal; determines the carrier phase double difference measurement value of the mobile terminal after eliminating the clock error according to the carrier phase single difference measurement value of the mobile terminal and the reference terminal respectively, and determines the final positioning result of the mobile terminal according to the rough positioning result and the carrier phase double difference measurement value, thereby completing high-precision indoor rapid positioning. Thus, the current problems of low indoor positioning accuracy and poor real-time performance are solved.
[0031] Additional aspects and advantages of the present application will be given in part in the description below, and in part will become apparent from the description below, or will be learned through the practice of the present application. BRIEF DESCRIPTION OF THE DRAWINGS
[0032] The above and / or additional aspects and advantages of the present application will become apparent and easily understood from the following description of the embodiments in conjunction with the accompanying drawings, in which:
[0033] Figure 1 A flowchart of an indoor positioning method provided according to an embodiment of the present application;
[0034] Figure 2 A flow chart of a full-week iterative solution algorithm based on multiple time points provided according to an embodiment of the present application;
[0035] Figure 3 An exemplary diagram of an indoor positioning device is provided according to an embodiment of the present application;
[0036] Figure 4 A schematic diagram of the structure of a server provided according to an embodiment of the present application.
[0037] Description of reference numerals: acquisition module-100, calculation module-200, determination module-300, positioning module-400, memory-401, processor-402 and communication interface-403. DETAILED DESCRIPTION
[0038] The embodiments of the present application are described in detail below, and examples of the embodiments are shown in the accompanying drawings, wherein the same or similar reference numerals throughout represent the same or similar elements or elements having the same or similar functions. The embodiments described below with reference to the accompanying drawings are exemplary and are intended to be used to explain the present application, and should not be construed as limiting the present application.
[0039] The indoor positioning method, device, server, storage medium and program of the embodiment of the present application are described below with reference to the accompanying drawings. In response to the problems mentioned in the above background technology, the present application provides an indoor positioning method, in which the TDOA observation values and carrier phase observation values of the mobile terminal and the reference terminal with all wireless access points are obtained; the TDOA differential measurement value is calculated according to the above TDOA observation value, and the carrier phase single difference measurement value is calculated according to the carrier phase observation value; the TDOA observation value of the mobile terminal after eliminating the clock error is calculated according to the position of the reference terminal and the TDOA differential measurement value, so as to determine the rough positioning result of the mobile terminal; the carrier phase double difference measurement value of the mobile terminal after eliminating the clock error is determined according to the single difference measurement value of the carrier phase of the mobile terminal and the reference terminal, and the final positioning result of the mobile terminal is determined according to the rough positioning result and the carrier phase double difference measurement value, so as to complete high-precision indoor rapid positioning. Thereby, the current problems of low indoor positioning accuracy and poor real-time performance are solved.
[0040] Specifically, Figure 1 A flowchart of an indoor positioning method provided in an embodiment of the present application.
[0041] like Figure 1 As shown, the indoor positioning method includes the following steps:
[0042] In step S101, TDOA observation values and carrier phase observation values of the mobile terminal and the reference terminal respectively with all wireless access points are obtained.
[0043] It is understood that a mobile terminal is a terminal device that can perform all functions related to transmission on a wireless interface, such as a tablet computer, a mobile phone, a car computer, etc., which is not specifically limited here. A reference terminal refers to a terminal device that serves as a reference, which is not specifically limited here.
[0044] For example, the embodiment of the present application can set the positioning scene in an indoor three-dimensional space, where there are M fixed wireless access points with known positions, numbered 1, 2, ..., M, and position coordinates u i =(x i ,y i , z i ) T , i = 1, 2, ..., M. Set the wireless access point numbered 1 as the reference wireless access point, and the other wireless access points combine their measured values to obtain the corresponding TDOA values. In addition to the wireless access points, there are two terminals in the three-dimensional space, one is a mobile terminal s, whose position is unknown and whose coordinates at time t are can move randomly in three-dimensional space; the other is the reference terminal r, whose position is known and fixed, with coordinates u (r) =(x (r) ,y (r) , z (r) ) T Assume that during the positioning process, the two terminals can always communicate directly with each wireless access point. Each wireless access point can receive the transmission frequency of the two terminals at f c The C-PRS signal is received and the TOA value and carrier phase value of the received signal are observed.
[0045] The following will describe the ranging of TDOA observation values and carrier phase observation values in detail, as follows:
[0046] (1) The specific method of TDOA ranging is as follows:
[0047] At time t, the wireless access point numbered i (i=1, 2, ..., M) receives the continuous signal transmitted by the mobile terminal s and observes the TOA value to be
[0048]
[0049] Where c is the speed of light, is the actual distance between the mobile terminal s and the wireless access point numbered i, is the time measurement error of the wireless access point numbered i. Assuming that the time measurement errors between different base stations are independent of each other, is the clock difference between the wireless access point numbered i and the mobile terminal s. The TOA observation value of the wireless access point numbered i is subtracted from the observation value of the reference wireless access point, and the TDOA observation value is obtained as:
[0050]
[0051] Among them, Δ(·) (i,1) =(·) (i) -(·) (1) Similarly, the TDOA observation value of reference terminal r can be expressed as
[0052]
[0053] Among them, in formula 2 and in Formula 3 Equal, TDOA observation value Reduces the clock requirements for the terminal, It is only related to the clock errors of wireless access points numbered 1 and i, which is equal to the difference between the clock errors of the two wireless access points. They are expressed as Right now
[0054]
[0055] The wireless access points numbered 2, 3, ..., M obtain the corresponding TDOA observation values at time t by combining the measurement values of the reference wireless access points. Here they are uniformly expressed in the form of vectors
[0056] Δd t =c -1 Δr t +Δn t +Δb t (5)
[0057] in, x represents s or r. The corresponding distance value or distance difference can be obtained by multiplying the TOA observation value or TDOA observation value by the speed of light c.
[0058] (2) Carrier phase ranging is as follows:
[0059] Carrier phase ranging is often used in GNSS. Due to the periodicity of the carrier phase signal, the signal receiver can only observe a phase φ that is less than one period. r , is called the residual part of the phase, while the integer multiple period part 2πN of the phase is unknown, where N is the integer ambiguity. The true phase can be expressed as
[0060]
[0061] To obtain the true phase, it is necessary to accurately resolve the integer ambiguity N. At the beginning of the observation, the signal receiver observes the residual part of the phase φ r At the same time, the phase-locked loop or frequency-locked loop tracks the carrier phase. As time changes, the distance between the signal transmitter and the signal receiver may change, which means that the real phase may change. As long as the phase-locked loop or frequency-locked loop does not lose lock, the integer ambiguity N observed by the signal receiver in the initial stage remains unchanged, and the change in the real phase is reflected in the phase residual part. The phase of the carrier phase signal observed by the mobile terminal s from the wireless access point numbered i at time t can be expressed as
[0062]
[0063] in, is the integer ambiguity present at the time of initial lock and is an integer, λ is the wavelength of the wireless signal, is the error of the observed carrier phase. Assuming that the carrier phase observation errors between different base stations are independent of each other, f c is the carrier frequency of the continuous signal. Similarly, the phase of the carrier phase signal observed by the reference terminal r at time t from the wireless access point numbered i can be expressed as
[0064]
[0065] In step S102, TDOA differential measurement values are calculated based on TDOA observation values of the mobile terminal and the reference terminal respectively with all wireless access points, and carrier phase single difference measurement values are calculated based on carrier phase observation values of the mobile terminal and the reference terminal respectively with all wireless access points.
[0066] It can be understood that there is a clock error in the TDOA observation value. The TDOA differential measurement value calculated by the TDOA observation value can be the difference between the clock errors of the mobile terminal and the reference terminal and all wireless access points. The carrier phase single difference measurement value can be calculated by subtracting the carrier phase observation value of the wireless access point of the mobile terminal from the carrier phase observation value of the wireless access point of the reference terminal.
[0067] Specifically, in order to eliminate the impact of clock errors between devices on positioning accuracy, the embodiment of the present application introduces a fixed reference terminal r with a known position. For TDOA observation values, considering the reference wireless access point numbered 1, the wireless access point numbered i, the mobile terminal s, and the reference terminal r, the TDOA differential measurement value or TOA double difference measurement value can be obtained by subtracting formula 2 from formula 3:
[0068]
[0069] Since the location of the reference terminal r is known, is a known quantity.
[0070] For the carrier phase observation value, consider the reference wireless access point numbered 1, the wireless access point numbered i, and the mobile terminal s. and The difference can be obtained by measuring the single difference of the carrier phase
[0071]
[0072] Similarly, for the reference terminal r, there is a single-difference measurement of the carrier phase
[0073]
[0074] In step S103, the TDOA observation value of the mobile terminal after eliminating the clock error is calculated based on the position of the reference terminal and the TDOA differential measurement value, and the coarse positioning result of the mobile terminal is determined based on the TDOA observation value of the mobile terminal after eliminating the clock error.
[0075] It is understandable that the coarse positioning of the mobile terminal is determined by the TDOA observation value after eliminating the clock difference of the mobile terminal, and the influence of the clock difference between devices is eliminated by using TDOA differential measurement to improve the positioning accuracy, but the coarse positioning result often cannot achieve a very high positioning accuracy.
[0076] Specifically, according to Formula 4, Moving all known quantities to the left side of the equation, the TDOA observation value after the mobile terminal s eliminates the clock error is
[0077]
[0078] in, By comparing Formula 2 and Formula 12, it can be seen that the time measurement error term in Formula 2 is Its variance is is the TOA error measurement variance between wireless access point numbered i and user terminal s. Due to the introduction of the reference terminal measurement error in formula 12, the time measurement error term becomes Its variance is It can be seen that the standard deviation of the time measurement error of the TDOA observation value after eliminating the clock error is larger than the standard deviation before eliminating the clock error, but the introduction of a reference terminal r with a fixed position can completely eliminate the clock error between devices.
[0079] The observed TDOA vector Δd t Substituting into the traditional TDOA positioning algorithm, such as the Chan algorithm, a rough positioning result of the mobile terminal s at time t is obtained. Limited by the ranging accuracy of TDOA and the three-dimensional positioning scenario, the rough positioning result ut,p The positioning accuracy of the system often cannot achieve a very high positioning accuracy.
[0080] In step S104, the carrier phase double difference measurement value of the mobile terminal after eliminating the clock error is determined according to the respective carrier phase single difference measurement values of the mobile terminal and the reference terminal, and the final positioning result of the mobile terminal is determined according to the coarse positioning result and the carrier phase double difference measurement value.
[0081] It can be understood that the embodiments of the present application can eliminate the influence of the clock difference between devices on the positioning algorithm by introducing a reference terminal, combining the measurement values of the mobile terminal and the reference terminal, and utilizing the double difference measurement of the carrier phase to eliminate the influence of the clock difference between devices; by introducing a reference terminal, the clock difference between devices is eliminated by utilizing the coarse positioning result and the double difference measurement value of the carrier phase, thereby improving the positioning accuracy.
[0082] Specifically, the difference between Formula 10 and Formula 11 can be used to obtain the double difference measurement value of the carrier phase:
[0083]
[0084] Among them, Δ(·) s,r =(·) s -(·) r , The 4th carrier phase is the sum of the carrier phase measurement error variances of the two wireless access points observing the terminal s and the terminal r respectively.
[0085] In an embodiment of the present application, a final positioning result of a mobile terminal is determined based on a coarse positioning result and a carrier phase double difference measurement value, including: confirming a double difference equation based on the carrier phase double difference measurement value; performing integer iterative solutions to the double difference equation at multiple time points based on the coarse positioning result to obtain an integer ambiguity floating solution; calculating a distance difference between the mobile terminal and each wireless access point based on the integer ambiguity floating solution; and locating the position of the mobile terminal based on the distance difference between the mobile terminal and each wireless access point.
[0086] Specifically, similar to TOA measurement, while eliminating the clock error, a larger measurement variance is introduced.
[0087] because therefore Moving the known quantity to the left side of the equation gives the double difference equation
[0088]
[0089] in, There is no clock error in formula 14. Although the above two methods introduce larger measurement errors in the process of eliminating clock errors, the measurement error of TOA is usually at the sub-meter level, and the measurement error of carrier phase is even smaller, only a fraction of the wavelength. The clock error between devices is usually 50 to 100ns, which is tens of meters when converted into distance. Therefore, although this method of eliminating clock errors by double-difference measurement introduces larger measurement errors, it completely eliminates the impact of clock errors on positioning accuracy.
[0090] Carrier phase ranging has higher accuracy than TDOA ranging, so using the distance information obtained by carrier phase ranging for positioning can achieve higher positioning accuracy. The key to high-precision carrier phase ranging is the accurate resolution of the integer ambiguity N. From formula 14, we can see that in addition to the unknown double-difference integer ambiguity and double difference measurement error In addition, there are unknown quantities Will Expand to get
[0091]
[0092] in, They are all unknown quantities.
[0093] In an embodiment of the present application, the double difference equation is iteratively solved at multiple time points according to the coarse positioning result to obtain a floating solution for the integer ambiguity, including: performing an initial linearization on the double difference equation with the coarse positioning result as the initial Taylor expansion point; solving the initially linearized double difference equation to obtain a solution result, wherein the solution result includes the integer ambiguity and the position coordinates of the mobile terminal at multiple time points; starting from the solution result of the initially linearized double difference equation, the double difference equation is linearized based on the solution result of the current round of iterations until the solution result of the current round of iterations converges to obtain a floating solution for the integer ambiguity.
[0094] In each round of iteration, the phase-locked loop or the frequency-locked loop is set not to lose lock at multiple time points, and the target element of the double difference equation is updated.
[0095] It can be understood that by using the Taylor expansion method to linearize the rough positioning results based on the initial Taylor expansion points, and then combining the measurement equations of multiple time points to solve the integer ambiguity, more accurate Taylor expansion points can be obtained and more accurate integer ambiguity can be solved. Through iteration, the integer ambiguity can be quickly solved with fewer measurement values.
[0096] Specifically, the whole-week iterative solution algorithm process based on multiple time points in the embodiment of the present application is as follows: Figure 2 As shown, the details are as follows:
[0097] It can be seen from formula 15 that formula 14 is a nonlinear equation about the unknown position, which brings difficulties to the solution of the integer ambiguity N. Therefore, the embodiment of the present application first uses the Taylor expansion method to linearize formula 14 based on the initial Taylor expansion point coarse positioning result, and then combines the measurement equations of multiple time points to solve the integer ambiguity. Because the result of one solution includes the integer ambiguity and the position coordinates of the mobile terminal s at multiple time points, and a more accurate Taylor expansion point can be obtained, linearizing formula 14 again can solve more accurate integer ambiguity, and so on, through iteration, the integer ambiguity can be quickly solved with fewer measurement values.
[0098] Assume that the result of the k-1th iteration is u t,k-1 =(x t,k-1 ,y t,k-1 , z t,k-1 ) T , replace formula 15 with u t,k-1 Taylor expansion is performed on the linear equation to achieve the purpose of linearization. The expansion form is as follows
[0099]
[0100] Substituting Formula 16 into Formula 14, we get the Taylor expansion equation, and composing the Taylor expansion equations obtained by setting i equal to 2, 3, ..., M to form an equation system, which is as follows
[0101] b k =G k ΔX+γ k (17)
[0102] in, is the Taylor expansion coefficient matrix, E (M-1)(M-1) is the identity matrix of size M-1,
[0103] The necessary condition for the system of equations shown in Formula 17 to have a unique solution is that the number of equations ≥ the number of unknowns. The number of equations in the system of equations shown in Formula 17 is M-1, and the number of unknowns is 3+M-1, which does not meet the above conditions, so the system of equations shown in Formula 17 has no unique solution. In order to solve this dimensional problem, assuming that the phase-locked loop or frequency-locked loop does not lose lock at n (n≥2) time points, that is, the integer ambiguity N remains unchanged, the double difference equations at n time points (t, t+1,…, t+n-1) are combined into the system of equations shown in Formula 17, then the elements in the system of equations shown in Formula 17 are updated as follows: Z is a zero matrix of size (M-1)×3, Using the weighted least squares method to solve the system of equations shown in formula 17, we can obtain
[0104]
[0105] Where Q is the covariance matrix of the measurement error.
[0106]
[0107] The result u of the kth iteration can be obtained k ,in for The vector consisting of the first 3n elements in . k The iteration is continued as the Taylor expansion point, and so on, until the solution converges.
[0108] After the floating solution of the integer ambiguity is solved, the LAMBDA algorithm is used to obtain the fixed solution of the integer ambiguity. Here the integer ambiguity is fixed solution It is the double-difference integer ambiguity. According to formula 20, the phase difference can be corrected and the distance difference can be calculated.
[0109]
[0110] Substituting the distance difference into the traditional TDOA positioning algorithm can solve the final position estimate u f .
[0111] According to an indoor positioning method proposed in an embodiment of the present application, a reference terminal is introduced to eliminate the influence of the clock difference between devices on the positioning algorithm. In combination with the measurement values of the mobile terminal and the reference terminal, TDOA differential measurement and carrier phase double difference measurement are used to eliminate the influence of the clock difference between devices; the characteristic that the integer ambiguity does not change during the period when the phase-locked loop does not lose lock is used to design an integer iterative solution algorithm that combines multi-time point measurement data; on the basis of eliminating the clock difference between devices and iteratively solving the integer ambiguity in combination with multi-time point measurement data, high-precision indoor rapid positioning is completed, the solution of the integer ambiguity is accelerated, and the time required for positioning is shortened. Therefore, the current problems of low indoor positioning accuracy and poor real-time performance are solved.
[0112] Next, an indoor positioning device proposed according to an embodiment of the present application is described with reference to the accompanying drawings.
[0113] Figure 3 It is a block diagram of an indoor positioning device according to an embodiment of the present application.
[0114] like Figure 3 As shown, the indoor positioning device 10 includes: an acquisition module 100 , a calculation module 200 , a determination module 300 and a positioning module 400 .
[0115] Among them, the acquisition module 100 is used to obtain the TDOA observation values and carrier phase observation values of the mobile terminal and the reference terminal respectively with all wireless access points; the calculation module 200 is used to calculate the TDOA differential measurement value according to the TDOA observation values of the mobile terminal and the reference terminal respectively with all wireless access points, and calculate the carrier phase single difference measurement value according to the carrier phase observation values of the mobile terminal and the reference terminal respectively with all wireless access points; the determination module 300 is used to calculate the TDOA observation value of the mobile terminal after eliminating the clock error according to the position of the reference terminal and the TDOA differential measurement value, and determine the coarse positioning result of the mobile terminal according to the TDOA observation value after eliminating the clock error of the mobile terminal; the positioning module 400 is used to determine the carrier phase double difference measurement value of the mobile terminal after eliminating the clock error according to the carrier phase single difference measurement value of the mobile terminal and the reference terminal respectively, and determine the final positioning result of the mobile terminal according to the coarse positioning result and the carrier phase double difference measurement value.
[0116] In the embodiment of the present application, the positioning module 400 also includes: determining the double difference equation according to the carrier phase double difference measurement value; performing integer iterative solution of the double difference equation at multiple time points according to the coarse positioning result to obtain an integer ambiguity floating solution; calculating the distance difference between the mobile terminal and each wireless access point according to the integer ambiguity floating solution; and locating the position of the mobile terminal according to the distance difference between the mobile terminal and each wireless access point.
[0117] In an embodiment of the present application, the positioning module 400 also includes: performing an initial linearization on the double difference equation using the coarse positioning result as the initial Taylor expansion point; solving the initially linearized double difference equation to obtain a solution result, wherein the solution result includes the integer ambiguity and the position coordinates of the mobile terminal at multiple time points; starting from the solution result of the initially linearized double difference equation, linearizing the double difference equation based on the solution result of the current round of iteration until the solution result of the current round of iteration converges to obtain a floating solution for the integer ambiguity.
[0118] In an embodiment of the present application, during each round of iteration, a phase-locked loop or a frequency-locked loop is set not to lose lock at multiple time points, and a target element of the double difference equation is updated.
[0119] In the embodiment of the present application, the double difference equation is:
[0120]
[0121] in, is the distance difference, λ is the wavelength of the wireless signal, is the double difference integer ambiguity, is the double difference measurement error.
[0122] In the embodiment of the present application, the distance difference is calculated as follows:
[0123]
[0124] in, is the phase of the carrier phase signal from the wireless access point numbered i observed by the mobile terminal s at time t, is the phase of the carrier phase signal from the wireless access point numbered i observed by the reference terminal r at time t, λ is the wavelength of the wireless signal, is the double-difference integer ambiguity, is a known quantity.
[0125] It should be noted that the above explanation of the indoor positioning method embodiment is also applicable to the indoor positioning device of this embodiment, and will not be repeated here.
[0126] According to the indoor positioning device proposed in the embodiment of the present application, the reference terminal is introduced to eliminate the influence of the clock difference between devices on the positioning algorithm. In combination with the measurement values of the mobile terminal and the reference terminal, TDOA differential measurement and carrier phase double difference measurement are used to eliminate the influence of the clock difference between devices; the characteristic that the integer ambiguity does not change during the period when the phase-locked loop does not lose lock is used to design an integer iterative solution algorithm that combines multi-time point measurement data; on the basis of eliminating the clock difference between devices and iteratively solving the integer ambiguity in combination with multi-time point measurement data, high-precision indoor rapid positioning is completed, the solution of the integer ambiguity is accelerated, and the time required for positioning is shortened. Therefore, the current problems of low indoor positioning accuracy and poor real-time performance are solved.
[0127] Figure 4 A schematic diagram of the structure of a server provided in an embodiment of the present application. The server may include:
[0128] Memory 401 , processor 402 , and a computer program stored in the memory 401 and executable on the processor 402 .
[0129] When the processor 402 executes the program, the indoor positioning method provided in the above embodiment is implemented.
[0130] Furthermore, the server also includes:
[0131] The communication interface 403 is used for communication between the memory 401 and the processor 402 .
[0132] The memory 401 is used to store computer programs that can be executed on the processor 402 .
[0133] The memory 401 may include a high-speed RAM (Random Access Memory) memory, and may also include a non-volatile memory, such as at least one disk memory.
[0134] If the memory 401, the processor 402 and the communication interface 403 are implemented independently, the communication interface 403, the memory 401 and the processor 402 can be connected to each other through a bus and communicate with each other. The bus can be an ISA (Industry Standard Architecture) bus, a PCI (Peripheral Component Interconnect) bus or an EISA (Extended Industry Standard Architecture) bus, etc. The bus can be divided into an address bus, a data bus, a control bus, etc. For ease of representation, Figure 4 Only one thick line is used in the diagram, but this does not mean that there is only one bus or only one type of bus.
[0135] Optionally, in a specific implementation, if the memory 401, the processor 402 and the communication interface 403 are integrated on a chip, the memory 401, the processor 402 and the communication interface 403 can communicate with each other through an internal interface.
[0136] The processor 402 may be a CPU (Central Processing Unit), or an ASIC (Application Specific Integrated Circuit), or one or more integrated circuits configured to implement the embodiments of the present application.
[0137] An embodiment of the present application provides a computer-readable storage medium having a computer program stored thereon, which implements the above-mentioned indoor positioning method when executed by a processor.
[0138] An embodiment of the present application provides a computer program product, including a computer program or instructions, which is used to implement the above indoor positioning method when the computer program is executed.
[0139] In the description of this specification, the description with reference to the terms "one embodiment", "some embodiments", "example", "specific example", or "some examples" etc. means that the specific features, structures, materials or characteristics described in conjunction with the embodiment or example are included in at least one embodiment or example of the present application. In this specification, the schematic representations of the above terms are not necessarily directed to the same embodiment or example. Moreover, the specific features, structures, materials or characteristics described may be combined in any one or N embodiments or examples in a suitable manner. In addition, those skilled in the art may combine and combine the different embodiments or examples described in this specification and the features of the different embodiments or examples, without contradiction.
[0140] In addition, the terms "first" and "second" are used for descriptive purposes only and should not be understood as indicating or implying relative importance or implicitly indicating the number of technical features indicated. Therefore, a feature defined as "first" or "second" may explicitly or implicitly include at least one of the features. In the description of this application, "N" means at least two, such as two, three, etc., unless otherwise clearly and specifically defined.
[0141] Any process or method description in a flowchart or otherwise described herein may be understood to represent a module, fragment or portion of code comprising one or more executable instructions for implementing the steps of a custom logical function or process, and the scope of the preferred embodiments of the present application includes alternative implementations in which functions may not be performed in the order shown or discussed, including performing functions in a substantially simultaneous manner or in reverse order depending on the functions involved, which should be understood by technicians in the technical field to which the embodiments of the present application belong.
[0142] It should be understood that the various parts of the present application can be implemented by hardware, software, firmware or a combination thereof. In the above-mentioned embodiment, the N steps or methods can be implemented by software or firmware stored in a memory and executed by a suitable instruction execution system. For example, if implemented by hardware, as in another embodiment, it can be implemented by any one of the following technologies known in the art or their combination: a discrete logic circuit having a logic gate circuit for implementing a logic function for a data signal, a dedicated integrated circuit having a suitable combination of logic gate circuits, a programmable gate array, a field programmable gate array, etc.
[0143] A person skilled in the art may understand that all or part of the steps in the above-mentioned embodiment method may be completed by instructing related hardware through a program, and the program may be stored in a computer-readable storage medium, which, when executed, includes one or a combination of the steps of the method embodiment.
Claims
1. An indoor positioning method, characterized in that: The following steps are involved: Obtain TDOA observation values and carrier phase observation values of the mobile terminal and the reference terminal respectively with all wireless access points; Calculating TDOA differential measurement values according to TDOA observation values of the mobile terminal and the reference terminal respectively with all wireless access points, and calculating carrier phase single difference measurement values according to carrier phase observation values of the mobile terminal and the reference terminal respectively with all wireless access points; Calculating the TDOA observation value of the mobile terminal after eliminating the clock error according to the position of the reference terminal and the TDOA differential measurement value, and determining the coarse positioning result of the mobile terminal according to the TDOA observation value of the mobile terminal after eliminating the clock error; The carrier phase double difference measurement value of the mobile terminal after eliminating the clock error is determined according to the respective carrier phase single difference measurement values of the mobile terminal and the reference terminal, and the final positioning result of the mobile terminal is determined according to the coarse positioning result and the carrier phase double difference measurement value.
2. The indoor positioning method according to claim 1, characterized in that: The determining the final positioning result of the mobile terminal according to the coarse positioning result and the carrier phase double difference measurement value includes: Determine the double difference equation according to the carrier phase double difference measurement value; According to the coarse positioning result, the double difference equation is solved by integer iteration at multiple time points to obtain an integer ambiguity floating solution; Calculating the distance difference between the mobile terminal and each wireless access point according to the integer ambiguity floating solution; The position of the mobile terminal is located according to the distance difference between the mobile terminal and each wireless access point.
3. The indoor positioning method according to claim 2, characterized in that: The step of performing integer iterative solution of the double difference equation at multiple time points according to the coarse positioning result to obtain an integer ambiguity floating solution includes: Performing initial linearization on the double difference equation using the rough positioning result as an initial Taylor expansion point; Solving the double difference equation of the initial linearization to obtain a solution result, wherein the solution result includes integer ambiguity and position coordinates of the mobile terminal at multiple time points; Starting from the solution result of the double difference equation of the initial linearization, the double difference equation is linearized based on the solution result of the current round of iterations, until the solution result of the current round of iterations converges to obtain an integer ambiguity floating solution.
4. The indoor positioning method according to claim 3, characterized in that: In each round of iteration, the phase-locked loop or the frequency-locked loop is set not to lose lock at multiple time points, and the target element of the double difference equation is updated.
5. The indoor positioning method according to claim 2, characterized in that: The double difference equation is: in, is the distance difference, λ is the wavelength of the wireless signal, is the double difference integer ambiguity, is the double difference measurement error.
6. The indoor positioning method according to claim 2, characterized in that: The calculation formula of the distance difference is: in, is the phase of the carrier phase signal from the wireless access point numbered i observed by the mobile terminal s at time t, is the phase of the carrier phase signal from the wireless access point numbered i observed by the reference terminal r at time t, λ is the wavelength of the wireless signal, is the double difference integer ambiguity, is a known quantity.
7. An indoor positioning device, characterized in that: include: An acquisition module, used to acquire TDOA observation values and carrier phase observation values of the mobile terminal and the reference terminal respectively with all wireless access points; A calculation module, configured to calculate a TDOA differential measurement value based on the TDOA observation values of the mobile terminal and the reference terminal respectively with all wireless access points, and calculate a carrier phase single difference measurement value based on the carrier phase observation values of the mobile terminal and the reference terminal respectively with all wireless access points; A determination module, configured to calculate the TDOA observation value of the mobile terminal after the clock error of the mobile terminal is eliminated according to the position of the reference terminal and the TDOA differential measurement value, and determine the coarse positioning result of the mobile terminal according to the TDOA observation value of the mobile terminal after the clock error is eliminated; The positioning module is used to determine the carrier phase double difference measurement value of the mobile terminal after eliminating the clock error based on the respective carrier phase single difference measurement values of the mobile terminal and the reference terminal, and determine the final positioning result of the mobile terminal based on the coarse positioning result and the carrier phase double difference measurement value.
8. A server, characterized in that: include: A memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor executes the program to implement an indoor positioning method as described in any one of claims 1 to 6.
9. A computer-readable storage medium having a computer program stored thereon, characterized in that: The program is executed by a processor to implement an indoor positioning method as described in any one of claims 1 to 6.
10. A computer program product comprising a computer program or instructions, characterized in that When the computer program or instruction is executed, the indoor positioning method according to any one of claims 1 to 6 is implemented.
