UWB-based indoor positioning method and related equipment

By filtering, smoothing, and interpolating UWB data, and combining this with position jitter index correction, the data jitter problem of UWB positioning technology under static conditions is solved, thus improving positioning accuracy.

CN118936467AActive Publication Date: 2024-11-12湖南芒果融创科技有限公司

Patent Information

Application Number
CN202410871689.9
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-01
Publication Date
2024-11-12
Estimated Expiration
2044-07-01

AI Technical Summary

Technical Problem

UWB positioning technology suffers from data jitter error under static conditions, which affects positioning accuracy.

Method used

A method combining unscented Kalman filtering, exponential smoothing, and cubic spline interpolation is used to filter, smooth, and interpolate UWB data, and the data jitter is reduced by calculating the position jitter index.

Benefits of technology

It effectively reduces noise interference in UWB data, reduces data jitter, and improves the accuracy of indoor positioning.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118936467A_ABST
    Figure CN118936467A_ABST
Patent Text Reader

Abstract

The invention is suitable for the technical field of indoor positioning, and provides a UWB-based indoor positioning method and related equipment, and the method comprises the steps: collecting the historical UWB data of a target, and calculating a position jitter index; the method comprises the following steps: collecting real-time UWB data of a target, and filtering the real-time UWB data by using unscented Kalman filtering; smoothing the filtered UWB data by using an exponential smoothing algorithm; performing interpolation on the smoothed UWB data by using a cubic spline interpolation algorithm; and according to the historical UWB data, calculating the average speed of the target at a plurality of historical moments, and according to the average speed and the position jitter index, correcting the UWB data after interpolation to obtain corrected UWB data. According to the invention, the data jitter error of the UWB data can be reduced, and the accuracy of indoor positioning is improved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application belongs to the field of indoor positioning technology, and in particular, relates to an indoor positioning method and related equipment based on UWB. Background Art

[0002] Indoor positioning technology is widely used in the fields of Internet of Things, shopping mall navigation, logistics management, smart home, security monitoring, etc. The main indoor positioning technologies currently used are: WIFI positioning, Bluetooth positioning, radio frequency identification (RFID) positioning, ultrasonic positioning, optical positioning, inertial navigation, ultra-wideband (UWB) positioning, etc.

[0003] The technical principles, advantages and disadvantages of the several indoor positioning technologies listed above are:

[0004] WIFI positioning: Use the strength of WIFI signals and signal transmission time to determine the location of the device indoors. Scan the surrounding WIFI signals with a mobile phone or other device to determine the location of the device relative to the WIFI router. Its characteristics are that it does not require additional hardware equipment and can achieve positioning using the existing WIFI infrastructure, which is low in cost; however, it is easily affected by signal interference and building structure, and has low positioning accuracy.

[0005] Bluetooth positioning: Use the strength and transmission time of Bluetooth signals to determine the location of a device indoors. Bluetooth beacons can be placed at different locations in a building, and indoor positioning can be achieved by detecting the distance and signal strength between the device and the beacon. Its characteristics are relatively high positioning accuracy, low power consumption, and suitable for mobile devices; but it requires additional Bluetooth beacon device deployment, and the signal transmission distance is limited, so it is not suitable for large-scale indoor positioning.

[0006] RFID positioning: RFID technology is used to achieve indoor positioning. By implanting RFID tags on objects or individuals, their locations can be determined by reading the information on the tags. Its characteristics are unique identification, long-distance identification, no environmental impact, and real-time monitoring; but it requires implanting RFID tags on objects, which is costly and only suitable for specific scenarios.

[0007] Ultrasonic positioning: Ultrasonic sensors are used to transmit and receive ultrasonic signals inside buildings, and the location of the device is determined by calculating the propagation time of the signal. It is characterized by high positioning accuracy and is suitable for scenarios that require high-precision positioning. It can achieve real-time positioning; however, it is affected by environmental noise and multipath effects, has weak anti-interference capabilities, and requires the deployment of a large number of ultrasonic sensors.

[0008] Optical positioning: Use cameras and image processing technology to achieve indoor positioning, and determine the location of the device by identifying landmarks or feature points in the building. Its characteristics are that it can improve very high positioning accuracy, especially suitable for scenes that require visual information, and can be combined with image processing technology to achieve automatic recognition and positioning; it is affected by lighting conditions and occlusion, requires relatively complex equipment and algorithm support, and is not suitable for no light or low light environments.

[0009] Inertial navigation: uses sensors such as accelerometers and gyroscopes to detect the motion state of the device to achieve indoor positioning. Its characteristics are that it can achieve real-time positioning and navigation, is not affected by the external environment, and is suitable for scenes that require fast response and high-precision positioning; but there is an error accumulation problem, and long-term use may lead to positioning deviations. It requires regular calibration and parameter updates, and is not suitable for positioning in a long-term static state.

[0010] UWB positioning: UWB technology is a wireless communication technology that determines the location of a device by transmitting a large number of low-power pulse signals in a very short time, measuring the propagation time and signal strength of the signal, and achieving centimeter-level positioning accuracy (most UWB sensors have an accuracy of about 10 to 30 cm). Its characteristics are very high positioning accuracy, which can achieve centimeter-level positioning accuracy and strong anti-interference ability; but it requires the deployment of dedicated UWB base stations, and data jitter will occur in static conditions.

[0011] Compared with other high-precision indoor positioning technologies, UWB positioning is cheaper, but the typical positioning accuracy can only reach about 10 to 30 cm. Especially under static conditions, UWB positioning data will produce irregular data jitter. Summary of the invention

[0012] The present application provides a UWB-based indoor positioning method and related equipment, which can reduce the data jitter error existing in UWB positioning data and improve the accuracy of positioning.

[0013] In a first aspect, the present application provides an indoor positioning method based on UWB, comprising:

[0014] Collect historical UWB data of the target at multiple historical moments, and calculate the target's position jitter index based on the historical UWB data;

[0015] Collect the real-time UWB data of the target at the current moment, and filter the real-time UWB data using an unscented Kalman filter to obtain filtered UWB data;

[0016] The filtered UWB data is smoothed by using an exponential smoothing algorithm to obtain smoothed UWB data;

[0017] The smoothed UWB data is interpolated using a cubic spline interpolation algorithm to obtain interpolated UWB data;

[0018] According to the speed and position jitter index of the target at the current moment, the interpolated UWB data is corrected to obtain the corrected UWB data.

[0019] Optionally, the position jitter index is calculated as:

[0020]

[0021] Wherein, MAD represents the position jitter index, N represents the total number of historical moments, i represents the i-th historical moment, j represents the j-th historical moment, and x i represents the historical UWB data at the i-th historical moment, x j Represents the historical UWB data at the j-th historical moment, i, j = 1, 2, ..., N, i ≠ j.

[0022] Optionally, the real-time UWB data is filtered using an unscented Kalman filter to obtain filtered UWB data, including:

[0023] Construct the state transition model of the target; the expression of the state transition model is: k =f(x k-1 ,μ k-1 ,w k-1) , where x k represents the state vector of the target at time step k, x k-1 represents the state vector of the target at time step k-1, μ k-1 represents the UWB data of the target at time step k-1, w k-1 Represents μ k-1 The noise, time step k is the current moment, and time step k-1 is the moment before the current moment;

[0024] By calculating the formula P k =FP k-1 F T +Q, get the covariance matrix P of the target at time step k k ; Where F represents the state transfer matrix, Q represents the process noise covariance matrix, P k-1 represents the covariance matrix of the target at time step k-1;

[0025] By calculating the formula

[0026] K=P k H T (HP k H T +R) -1

[0027] x' k =x k +K(z k -Hx k )

[0028] P k =(I-KH)P k

[0029] Get the filtered UWB data x' k ; where H represents the observation matrix, R represents the measurement noise covariance matrix, and z k represents the observation vector, z k =h(x k ,v k ), v k represents observation noise, h() represents the observation model, and I represents the identity matrix.

[0030] Optionally, the filtered UWB data is smoothed using an exponential smoothing algorithm to obtain smoothed UWB data, including:

[0031] By calculating the formula S t =ax' k +(1-α)S t-1 , get the smoothed UWB data S t , t represents the current time, S t-1 represents the UWB data of the target at time t-1; where a represents the smoothing coefficient, α∈[0,1].

[0032] Optionally, the smoothed UWB data is interpolated using a cubic spline interpolation algorithm to obtain interpolated UWB data, including:

[0033] By calculating the formula h t =S t+1 -S t , get the position S of the target at time t+1 t+1 and the position S of the target at time t t The distance between t ;

[0034] Construct a cubic spline polynomial: S t (x t )=a t +b t (xx t )+c t (xx t ) 2 +d t (xx t ) 3 ;

[0035] Using distance h t Solve for the coefficient a of the cubic spline polynomial t ,b t ,c t ,d t ;

[0036] The coefficient a obtained by solving t ,b t ,c t ,d t Substituting into the cubic spline polynomial, the equation of the curve of the interpolated UWB data from time t to time t+1 is obtained, and the interpolated UWB data is obtained according to the equation of the curve;

[0037] Among them, x t represents the smoothed UWB data, and x represents the UWB data of the target at time t+1 after being processed by unscented Kalman filtering and exponential smoothing algorithm.

[0038] Optionally, the interpolated UWB data is corrected according to the speed and position jitter index of the target at the current moment to obtain corrected UWB data, including:

[0039] The value of the position jitter index is used as the speed threshold;

[0040] Determine the current speed of the target at the current moment according to the position of the target at the current moment and at multiple moments after the current moment;

[0041] If the current speed is less than the speed threshold and the absolute value of the target's position at the current moment minus the position at the previous moment is less than the preset distance threshold, the position of the target in the interpolated UWB data is corrected to the position of the target at the previous moment.

[0042] In a second aspect, the present application provides an indoor positioning device based on UWB, comprising:

[0043] A data preprocessing module is used to collect historical UWB data of the target at multiple historical moments and calculate the position jitter index of the target based on the historical UWB data;

[0044] The primary processing module is used to collect the real-time UWB data of the target at the current moment, and filter the real-time UWB data using an unscented Kalman filter to obtain filtered UWB data;

[0045] The secondary processing module is used to smooth the filtered UWB data using an exponential smoothing algorithm to obtain smoothed UWB data;

[0046] A third-level processing module, for interpolating the smoothed UWB data using a cubic spline interpolation algorithm to obtain interpolated UWB data;

[0047] The data correction module is used to correct the interpolated UWB data according to the speed and position jitter index of the target at the current moment to obtain the corrected UWB data.

[0048] In a third aspect, the present application provides a terminal device, including a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor implements the above-mentioned indoor positioning method when executing the computer program.

[0049] In a fourth aspect, the present application provides a computer-readable storage medium, which stores a computer program. When the computer program is executed by a processor, the above-mentioned indoor positioning method is implemented.

[0050] The above solution of the present application has the following beneficial effects:

[0051] The UWB-based indoor positioning method provided in the present application can effectively reduce noise interference in UWB data, reduce data jitter, and improve the accuracy of indoor positioning by filtering, smoothing and interpolating real-time UWB data at the current moment; and correct the UWB data by calculating the position jitter index, thereby further reducing data jitter error and improving the accuracy of indoor positioning.

[0052] Other beneficial effects of the present application will be described in detail in the subsequent specific implementation section. BRIEF DESCRIPTION OF THE DRAWINGS

[0053] In order to more clearly illustrate the technical solutions in the embodiments of the present application, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present application. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying any creative work.

[0054] Figure 1 A flowchart of a UWB-based indoor positioning method provided in an embodiment of the present application;

[0055] Figure 2 A schematic diagram of the structure of a UWB-based indoor positioning device provided in one embodiment of the present application;

[0056] Figure 3 A schematic diagram of the structure of a terminal device provided in one embodiment of the present application. DETAILED DESCRIPTION

[0057] In the following description, specific details such as specific system structures, technologies, etc. are provided for the purpose of illustration rather than limitation, so as to provide a thorough understanding of the embodiments of the present application. However, it should be clear to those skilled in the art that the present application may also be implemented in other embodiments without these specific details. In other cases, detailed descriptions of well-known systems, devices, circuits, and methods are omitted to prevent unnecessary details from obstructing the description of the present application.

[0058] It should be understood that when used in the present specification and the appended claims, the term "comprising" indicates the presence of described features, wholes, steps, operations, elements and / or components, but does not exclude the presence or addition of one or more other features, wholes, steps, operations, elements, components and / or combinations thereof.

[0059] It should also be understood that the term “and / or” used in the specification and appended claims refers to any and all possible combinations of one or more of the associated listed items, and includes these combinations.

[0060] As used in the specification and appended claims of this application, the term "if" can be interpreted as "when" or "uponce" or "in response to determining" or "in response to detecting", depending on the context. Similarly, the phrase "if it is determined" or "if [described condition or event] is detected" can be interpreted as meaning "uponce it is determined" or "in response to determining" or "uponce [described condition or event] is detected" or "in response to detecting [described condition or event]", depending on the context.

[0061] In addition, in the description of the present application specification and the appended claims, the terms "first", "second", "third", etc. are only used to distinguish the descriptions and cannot be understood as indicating or implying relative importance.

[0062] References to "one embodiment" or "some embodiments" etc. described in the specification of this application mean that one or more embodiments of the present application include specific features, structures or characteristics described in conjunction with the embodiment. Therefore, the statements "in one embodiment", "in some embodiments", "in some other embodiments", "in some other embodiments", etc. that appear in different places in this specification do not necessarily refer to the same embodiment, but mean "one or more but not all embodiments", unless otherwise specifically emphasized in other ways. The terms "including", "comprising", "having" and their variations all mean "including but not limited to", unless otherwise specifically emphasized in other ways.

[0063] In response to the data jitter problem of UWB data, the present application provides an indoor positioning method based on UWB. By filtering, smoothing and interpolating the real-time UWB data at the current moment, the noise interference in the UWB data can be effectively reduced, the data jitter can be reduced, and the accuracy of indoor positioning can be improved. By calculating the jitter index of historical UWB data to correct the UWB data, the data jitter error can be further reduced, and the accuracy of indoor positioning can be improved.

[0064] The UWB-based indoor positioning method provided in this application is described in detail below.

[0065] like Figure 1 As shown, the UWB-based indoor positioning method includes the following steps:

[0066] Step 11, collecting historical UWB data of the target at multiple historical moments, and calculating the position jitter index of the target based on the historical UWB data.

[0067] It should be understood that in the related art, UWB positioning technology refers to: sending a short pulse UWB signal through a tag (i.e. the above-mentioned target), and after multiple anchor points (i.e. reference points) receive the short pulse UWB signal, the propagation time of the short pulse UWB signal is calculated, and the distance between the tag (target) and the anchor point (reference point) is calculated, and the coordinates of the tag (target) are obtained based on the distance. Exemplarily, through a geometric algorithm (such as trilateration or multilateral measurement), the distance data between multiple anchor points and the tag can be used to infer the three-dimensional position of the tag (target). Among them, the tag can send a short pulse UWB signal through the UWB sensor installed on itself.

[0068] In one embodiment of the present application, the UWB data of the target refers to the position of the target determined based on the UWB positioning technology. It can be understood that the above historical UWB data refers to the position of the target at a historical moment.

[0069] It should be noted that the calculation of the position jitter index here is to prepare for the subsequent elimination of data jitter of the UWB data.

[0070] Specifically, the calculation formula of the jitter index is:

[0071]

[0072] Wherein, MAD represents the position jitter index, N represents the total number of historical moments, i represents the i-th historical moment, j represents the j-th historical moment, and x i represents the historical UWB data at the i-th historical moment, x j Represents the historical UWB data at the j-th historical moment, i, j = 1, 2, ..., N, i ≠ j.

[0073] Step 12: collect the real-time UWB data of the target at the current moment, and filter the real-time UWB data using an unscented Kalman filter to obtain filtered UWB data.

[0074] The above-mentioned real-time UWB data refers to the location of the target at the current moment, which is determined based on the UWB positioning technology.

[0075] The following is an explanation of the process of filtering the real-time UWB data using the unscented Kalman filter to obtain the filtered UWB data, including steps 12.1 to 12.3:

[0076] Step 12.1, construct the state transition model of the target.

[0077] The expression of the above state transition model is: k =f(x k-1 ,μ k-1 ,w k-1 ), where x k represents the state vector of the target at time step k, x k-1 represents the state vector of the target at time step k-1, μ k-1 represents the UWB data of the target at time step k-1, w k-1 Represents μ k-1 noise, time step k is the current moment, and time step k-1 is the moment before the current moment.

[0078] The above state vector can reflect the motion state of an object (ie, target), and it can be composed of multiple state variables (these state variables can be position, velocity, acceleration, etc.). In this application, only the position value is used as the state variable to calculate the state vector.

[0079] Step 12.2, calculate the formula P k =FP k-1 F T +Q, get the covariance matrix P of the target at time step k k .

[0080] Among them, F represents the state transfer matrix, Q represents the process noise covariance matrix, which is a parameter describing the uncertainty of the system model and is used to describe the uncertainty or noise in the system model. k-1 express The covariance matrix of the target at time step k-1, Δt is the data update interval, such as 0.02 seconds.

[0081] Step 12.3, by calculating the formula

[0082] K=P kH T (HP k H T +R) -1

[0083] x' k =x k +K(z k -Hx k )

[0084] P k =(I-KH)P k

[0085] Get the filtered UWB data x' k , x' k It can also be understood as a filtered state vector.

[0086] Where H is the observation matrix, which is used to map the state vector of the system to the observation space. R is the measurement noise covariance matrix, which describes the statistical characteristics of the observation noise and reflects the uncertainty or noise level in the observation data. k represents the observation vector, z k =h(x k ,v k ), v k represents observation noise, h() represents the observation model, and I represents the identity matrix.

[0087] Step 13: Smoothing the filtered UWB data using an exponential smoothing algorithm to obtain smoothed UWB data.

[0088] Specifically, the formula S can be used to calculate t =ax' k +(1-α)S t-1 , get the smoothed UWB data S t , t represents the current time, S t-1 represents the UWB data of the target at time t-1; where α represents the smoothing coefficient, α∈[0,1].

[0089] Step 14: interpolate the smoothed UWB data using a cubic spline interpolation algorithm to obtain interpolated UWB data.

[0090] Specifically, the interpolation process includes steps 14.1 to 14.3:

[0091] Step 14.1, calculate the formula h t =S t+1 -S t , get the position S of the target at time t+1 t+1 and the position S of the target at time t tThe distance between t . Among them, time t+1 is the next time of time t, and time t-1 is the previous time of time t.

[0092] It should be noted that since the UWB data of the target at each moment needs to be processed by filtering, smoothing, and interpolation, when the UWB data at time t enters the interpolation process, the UWB data at time t+1 has also been smoothed. Therefore, the position S of the target at time t+1 can be calculated. t+1 and the position S of the target at time t t The distance between t .

[0093] Step 14.2, construct the cubic spline polynomial:

[0094] S t (x t )=a t +b t (xx t )+c t (xx t ) 2 +d t (xx t ) 3 ; where x t represents the smoothed UWB data (i.e., the UWB data of the target at time t is processed by unscented Kalman filtering and exponential smoothing algorithm in sequence), and x represents the UWB data of the target at time t+1 is processed by unscented Kalman filtering and exponential smoothing algorithm in sequence.

[0095] It should be noted that the position indicated by the above UWB data is a two-dimensional coordinate position, usually including abscissa x and ordinate y. Of course, in order to distinguish the position at each moment, corresponding to each moment, it can be distinguished by adding subscripts to the abscissa x and ordinate y. For example, the position at time t can be expressed as: the abscissa is x t , the vertical coordinate is y t .

[0096] It can be understood that the above cubic spline polynomial is constructed based on the interpolation condition and the derivative continuity condition. The interpolation condition is: S t (x t )=y t and S t (x t+1 )=y t+1 ; The derivative continuity condition is: S t (x t+1 )=S t+1 (x t+1 ); First-order derivative continuity: S′ t (xt+1 ) = S′ t+1 (x t+1 ); Second-order derivative continuity: S″ t (x t+1 )=S″ t+1 (x t+1 ); boundary conditions (natural boundary, the second-order derivative is zero at the boundary): S″1(x1)=0 and S″ t-1 (x t )=0. t (x t+1 ) represents the cubic spline function in the interval t to t+1 at x=x t+1 The result when S t+1 (x t+1 ) represents the cubic spline function in the interval t+1 to t+2 at x=x t+1 The result when S″ t-1 (x t ) means when x=x t When t-1~t, the second-order derivative is t-1~t. It can be understood that x here represents the independent variable of the cubic spline function.

[0097] Among them, t is greater than 0. When constructing a cubic spline polynomial, for each t (that is, each t when taking different values):

[0098]

[0099] It should be noted that when t=0, no interpolation is performed and the data after exponential smoothing is directly output. This can be understood as an initialization process for this filtering system. During initialization, not all filtering algorithms will be useful.

[0100] Step 14.3, using the distance h t Solve for the coefficient a of the cubic spline polynomial t ,b t ,c t ,d t , and the coefficient a obtained by solving t ,b t ,c t ,d t Substituting into the cubic spline polynomial, the equation of the curve of the interpolated UWB data from time t to time t+1 is obtained, and the interpolated UWB data is obtained according to the equation of the curve.

[0101] In some embodiments of the present application, the equation of the curve from time t to time t+1 can be recorded as S t (x t )=y t . From this, we can calculate the coordinates of the interpolation point (x new ,ynew ). Among them, x new The horizontal coordinate of the interpolation position, y new Indicates the ordinate corresponding to the horizontal coordinate, x new Will be at x t and x t+1 The continuous number between them may have different results depending on the definition of the interpolation point, such as x t =0,x t+1 = 1, you can choose to insert ten values, then x new can be equal to 0, 0.1, 0.2, ..., 0.8, 0.9, 1, and the corresponding y new From the equation of the curve S t (x t )=y t Specifically, y new It means that the horizontal axis is x new The corresponding y t The value of y t The cubic spline function with a value of t~t+1 in the interval x=x new The result of time.

[0102] In some embodiments of the present application, C can be obtained by solving the above formula: r :

[0103]

[0104] Then use the following formula to calculate a t ,b t ,a t :

[0105] a t =y t

[0106]

[0107]

[0108] Step 15: Correct the interpolated UWB data according to the speed and position jitter index of the target at the current moment to obtain corrected UWB data.

[0109] In some embodiments of the present application, the interpolated UWB data may be corrected by the following steps:

[0110] Step 15.1, using the value of the position jitter index as a speed threshold.

[0111] Step 15.2, determining the current speed of the target at the current moment according to the position of the target at the current moment and at multiple moments after the current moment.

[0112] Since the reliability of the position data at a single moment is not high and there are deviations, in order to improve the accuracy, the target can be controlled to be stationary for a preset time (for example, a time period including the current moment and multiple moments after the current moment), and then the current speed of the target at the current moment is determined based on the position of the target at the current moment and multiple (such as 19) moments after the current moment.

[0113] Specifically, the average speed of the target between each two adjacent moments can be calculated based on the position of the target at the current moment and multiple (such as 19) moments after the current moment; then the average of the average speeds is used as the current speed of the target at the current moment.

[0114] Specifically, the calculation formula

[0115]

[0116] Get the average speed v of the target between the n+1th and nth moments; where (x n ,y n ) represents the UWB data of the target at the nth moment, x n is the horizontal coordinate of the UWB data, y n is the ordinate of the UWB data, t n represents the nth moment, (x n+1 ,y n+1 ) represents the UWB data of the target at the n+1th moment; x n+1 is the horizontal coordinate of the UWB data, y n+1 is the ordinate of the UWB data, t n+1 Indicates the n+1th moment.

[0117] Step 15.3, if the current speed is less than the speed threshold (such as 0.5m / s), and the absolute value of the target's position at the current moment minus the position at the previous moment is less than the preset distance threshold (such as 15cm), the position of the target in the interpolated UWB data is corrected to the position of the target at the previous moment (that is, the interpolated UWB data is corrected to the position of the target at the previous moment); otherwise, there is no need to correct the interpolated UWB data, and the interpolated UWB data is the actual position.

[0118] This can eliminate the positioning error caused by data jitter in UWB data and improve the accuracy of indoor positioning.

[0119] In summary, the UWB-based indoor positioning method provided by the present application can effectively reduce the noise interference in the UWB data, reduce the data jitter, and improve the accuracy of indoor positioning by filtering, smoothing and interpolating the real-time UWB data at the current moment; by calculating the jitter index and average speed of historical UWB data, the UWB data is corrected, which further reduces the data jitter error and improves the accuracy of indoor positioning.

[0120] The following is an exemplary description of the UWB-based indoor positioning device provided in the present application.

[0121] like Figure 2 As shown, the UWB-based indoor positioning device 200 includes:

[0122] The data preprocessing module 201 is used to collect historical UWB data of the target at multiple historical moments, and calculate the jitter index of the historical UWB data according to the historical UWB data;

[0123] The primary processing module 202 is used to collect the real-time UWB data of the target at the current moment, and filter the real-time UWB data using an unscented Kalman filter to obtain filtered UWB data;

[0124] The secondary processing module 203 is used to smooth the filtered UWB data using an exponential smoothing algorithm to obtain smoothed UWB data;

[0125] The third-level processing module 204 is used to interpolate the smoothed UWB data using a cubic spline interpolation algorithm to obtain interpolated UWB data;

[0126] The data correction module 205 is used to correct the interpolated UWB data according to the speed and position jitter index of the target at the current moment to obtain corrected UWB data.

[0127] It should be noted that the information interaction, execution process, etc. between the above-mentioned devices / units are based on the same concept as the method embodiment of the present application. Their specific functions and technical effects can be found in the method embodiment part and will not be repeated here.

[0128] The technicians in the relevant field can clearly understand that for the convenience and simplicity of description, only the division of the above-mentioned functional units and modules is used as an example for illustration. In practical applications, the above-mentioned function allocation can be completed by different functional units and modules as needed, that is, the internal structure of the device can be divided into different functional units or modules to complete all or part of the functions described above. The functional units and modules in the embodiment can be integrated in a processing unit, or each unit can exist physically separately, or two or more units can be integrated in one unit. The above-mentioned integrated unit can be implemented in the form of hardware or in the form of software functional units. In addition, the specific names of the functional units and modules are only for the convenience of distinguishing each other, and are not used to limit the scope of protection of this application. The specific working process of the units and modules in the above-mentioned system can refer to the corresponding process in the aforementioned method embodiment, which will not be repeated here.

[0129] like Figure 3 As shown, an embodiment of the present application provides a terminal device, such as Figure 3 As shown, the terminal device D10 of this embodiment includes: at least one processor D100 ( Figure 3 Only one processor is shown in the figure), a memory D101, and a computer program D102 stored in the memory D101 and executable on the at least one processor D100, wherein the processor D100 implements the steps of any of the above-mentioned method embodiments when executing the computer program D102.

[0130] Specifically, when the processor D100 executes the computer program D102, it can effectively reduce noise interference in the UWB data, reduce data jitter, and improve the accuracy of indoor positioning by filtering, smoothing, and interpolating the real-time UWB data at the current moment; it can correct the UWB data by calculating the position jitter index, further reducing the data jitter error and improving the accuracy of indoor positioning.

[0131] The processor D100 may be a central processing unit (CPU), or other general-purpose processors, digital signal processors (DSP), application-specific integrated circuits (ASIC), field-programmable gate arrays (FPGA), or other programmable logic devices, discrete gate or transistor logic devices, discrete hardware components, etc. A general-purpose processor may be a microprocessor or any conventional processor, etc.

[0132] In some embodiments, the memory D101 may be an internal storage unit of the terminal device D10, such as a hard disk or memory of the terminal device D10. In other embodiments, the memory D101 may also be an external storage device of the terminal device D10, such as a plug-in hard disk, a smart memory card (SMC, SmartMedia Card), a secure digital (SD, SecureDigital) card, a flash card (Flash Card), etc. equipped on the terminal device D10. Further, the memory D101 may also include both an internal storage unit of the terminal device D10 and an external storage device. The memory D101 is used to store an operating system, an application program, a boot loader (BootLoader), data, and other programs, such as the program code of the computer program, etc. The memory D101 may also be used to temporarily store data that has been output or is to be output.

[0133] An embodiment of the present application further provides a computer-readable storage medium, wherein the computer-readable storage medium stores a computer program, and when the computer program is executed by a processor, the steps in the above-mentioned method embodiments can be implemented.

[0134] An embodiment of the present application provides a computer program product. When the computer program product is run on a terminal device, the terminal device can implement the steps in the above-mentioned method embodiments when executing the computer program product.

[0135] If the integrated unit is implemented in the form of a software functional unit and sold or used as an independent product, it can be stored in a computer-readable storage medium. Based on this understanding, the present application implements all or part of the processes in the above-mentioned embodiment method, which can be completed by instructing the relevant hardware through a computer program, and the computer program can be stored in a computer-readable storage medium. When the computer program is executed by the processor, the steps of the above-mentioned various method embodiments can be implemented. Among them, the computer program includes computer program code, and the computer program code can be in source code form, object code form, executable file or some intermediate form. The computer-readable medium may at least include: any entity or device that can carry the computer program code to the indoor positioning device / terminal device based on UWB, recording medium, computer memory, read-only memory (ROM, Read-Only Memory), random access memory (RAM, Random Access Memory), electric carrier signal, telecommunication signal and software distribution medium. For example, a USB flash drive, a mobile hard disk, a magnetic disk or an optical disk. In some jurisdictions, according to legislation and patent practice, computer-readable media cannot be electric carrier signals and telecommunication signals.

[0136] In the above embodiments, the description of each embodiment has its own emphasis. For parts that are not described or recorded in detail in a certain embodiment, reference can be made to the relevant descriptions of other embodiments.

[0137] Those of ordinary skill in the art will appreciate that the units and algorithm steps of each example described in conjunction with the embodiments disclosed herein can be implemented in electronic hardware, or a combination of computer software and electronic hardware. Whether these functions are performed in hardware or software depends on the specific application and design constraints of the technical solution. Professional and technical personnel can use different methods to implement the described functions for each specific application, but such implementation should not be considered to be beyond the scope of this application.

[0138] In the embodiments provided in the present application, it should be understood that the disclosed devices / network equipment and methods can be implemented in other ways. For example, the device / network equipment embodiments described above are merely schematic. For example, the division of the modules or units is only a logical function division. There may be other division methods in actual implementation, such as multiple units or components can be combined or integrated into another system, or some features can be ignored or not executed. Another point is that the mutual coupling or direct coupling or communication connection shown or discussed can be through some interfaces, indirect coupling or communication connection of devices or units, which can be electrical, mechanical or other forms.

[0139] The units described as separate components may or may not be physically separated, and the components shown as units may or may not be physical units, that is, they may be located in one place or distributed on multiple 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.

[0140] The above is a preferred embodiment of the present application. It should be pointed out that for ordinary technicians in this technical field, several improvements and modifications can be made without departing from the principles described in the present application. These improvements and modifications should also be regarded as the scope of protection of the present application.

Claims

1. A UWB-based indoor positioning method, It is characterized in that include: Collecting historical UWB data of a target at multiple historical moments, and calculating a position jitter index of the target based on the historical UWB data; Collecting real-time UWB data of the target at the current moment, filtering the real-time UWB data using an unscented Kalman filter to obtain filtered UWB data; The filtered UWB data is smoothed by using an exponential smoothing algorithm to obtain smoothed UWB data; The smoothed UWB data is interpolated using a cubic spline interpolation algorithm to obtain interpolated UWB data; The interpolated UWB data is corrected according to the speed of the target at the current moment and the position jitter index to obtain corrected UWB data.

2. The indoor positioning method according to claim 1, It is characterized in that The calculation formula of the position jitter index is: Wherein, MAD represents the position jitter index, N represents the total number of historical moments, i represents the i-th historical moment, j represents the j-th historical moment, and x i represents the historical UWB data at the i-th historical moment, x j Represents the historical UWB data at the j-th historical moment, i, j = 1, 2, ..., N, i ≠ j.

3. The indoor positioning method according to claim 2, It is characterized in that The method of filtering the real-time UWB data by using an unscented Kalman filter to obtain filtered UWB data includes: Construct a state transition model of the target; the expression of the state transition model is: k =f(x k-1 ,μ k-1 ,w k-1 ), where x k represents the state vector of the target at time step k, x k-1 represents the state vector of the target at time step k-1, μ k-1 represents the UWB data of the target at time step k-1, w k-1 Represents μ k-1 The noise, time step k is the current moment, and time step k-1 is the moment before the current moment; By calculating the formula P k =FP k-1 F T +Q, get the covariance matrix P of the target at time step k k ; Where F represents the state transfer matrix, Q represents the process noise covariance matrix, P k-1 represents the covariance matrix of the target at time step k-1; By calculating the formula K=P k H T (HP k H T +R) -1 x' k =x k +K(z k -Hx k ) P k =(I-KH)P k Get the filtered UWB data x' k ; Where H represents the observation matrix, R represents the measurement noise covariance matrix, z k represents the observation vector, z k =h(x k ,v k ), v k represents observation noise, h() represents the observation model, and I represents the identity matrix.

4. The indoor positioning method according to claim 3, It is characterized in that The method of smoothing the filtered UWB data using an exponential smoothing algorithm to obtain smoothed UWB data includes: By calculating the formula S t =ax' k +(1-α)S t-1 , get the smoothed UWB data S t , t represents the current time, S t-1 represents the UWB data of the target at time t-1; wherein α represents the smoothing coefficient, α∈[0,1].

5. The indoor positioning method according to claim 4, It is characterized in that The method of interpolating the smoothed UWB data using a cubic spline interpolation algorithm to obtain interpolated UWB data includes: By calculating the formula h t =S t+1 -S t , get the position S of the target at time t+1 t+1 and the position S of the target at time t t The distance between t ; Construct a cubic spline polynomial: S t (x t )=a t +b t (xx t )+c t (xx t ) 2 +d t (xx t ) 3 ; Using the distance h t Solve for the coefficient a of the cubic spline polynomial t ,b t ,c t ,d t ; The coefficient a obtained by solving t ,b t ,c t ,d t Substituting the cubic spline polynomial into the equation, obtaining an equation of a curve of the interpolated UWB data from time t to time t+1, and obtaining the interpolated UWB data according to the equation of the curve; Among them, x t represents the smoothed UWB data, and x represents the UWB data of the target at time t+1 processed by unscented Kalman filtering and exponential smoothing algorithm in sequence.

6. The indoor positioning method according to claim 1, It is characterized in that The step of correcting the interpolated UWB data according to the speed of the target at the current moment and the position jitter index to obtain the corrected UWB data includes: Using the value of the position jitter index as a speed threshold; Determine the current speed of the target at the current moment according to the position of the target at the current moment and at multiple moments after the current moment; If the current speed is less than the speed threshold, and the absolute value of the target position at the current moment minus the position at the previous moment is less than the preset distance threshold, the position of the target in the interpolated UWB data is corrected to the position of the target at the previous moment.

7. An indoor positioning device based on UWB, It is characterized in that include: A data preprocessing module, used to collect historical UWB data of a target at multiple historical moments, and calculate a position jitter index of the target based on the historical UWB data; A primary processing module, used for collecting real-time UWB data of the target at the current moment, filtering the real-time UWB data using an unscented Kalman filter to obtain filtered UWB data; The secondary processing module is used to smooth the filtered UWB data using an exponential smoothing algorithm to obtain smoothed UWB data; A third-level processing module, for interpolating the smoothed UWB data using a cubic spline interpolation algorithm to obtain interpolated UWB data; The data correction module is used to correct the interpolated UWB data according to the speed of the target at the current moment and the position jitter index to obtain corrected UWB data.

8. A terminal device comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, It is characterized in that When the processor executes the computer program, the indoor positioning method according to any one of claims 1 to 6 is implemented.

9. A computer-readable storage medium storing a computer program. It is characterized in that When the computer program is executed by a processor, the indoor positioning method according to any one of claims 1 to 6 is implemented.

Citation Information

Patent Citations

  • Indoor cross-region seamless positioning system based on UWB technology

    CN110121150A

  • Spatial real-time positioning method, computer device and computer readable storage medium

    CN110657799A

  • Ultra-wideband signal jitter calculation method and device, electronic equipment and storage medium

    CN117040655A

  • TOF positioning method based on robust Kalman filtering

    CN118050680A

  • Intelligent-parking vehicle positioning method applied to vehicle

    WO2024066943A1

Cited By

  • Positioning calibration method based on UWB and vision and related equipment

    CN120195620A