CN107884745B - Atmospheric error processing method for UWB positioning - Google Patents
Atmospheric error processing method for UWB positioning Download PDFInfo
- Publication number
- CN107884745B CN107884745B CN201711003347.1A CN201711003347A CN107884745B CN 107884745 B CN107884745 B CN 107884745B CN 201711003347 A CN201711003347 A CN 201711003347A CN 107884745 B CN107884745 B CN 107884745B
- Authority
- CN
- China
- Prior art keywords
- label
- atmospheric
- delta
- base station
- coordinates
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
- G01S5/0205—Details
- G01S5/021—Calibration, monitoring or correction
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Mobile Radio Communication Systems (AREA)
- Radar Systems Or Details Thereof (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
The invention discloses an atmospheric error processing method aiming at UWB positioning, which solves the problem that the positioning accuracy of a label is reduced because a base station is far away from the position of the label when the real-time high-accuracy indoor positioning based on UWB is carried out, and the technical scheme is characterized in that: the method comprises the steps that the measurement distance between a label and a base station is obtained through UWB equipment, and an observation equation is established through the measurement distance between the base station and the label; introducing an atmospheric error parameter in the observation equation that is directly proportional to the measured distance; the position parameters and the atmospheric error parameters are compensated and calculated by a triangulation method, so that errors caused by atmospheric interference of signal propagation in the atmosphere are eliminated; the label position after the atmospheric error is eliminated and the real-time atmospheric error parameter are obtained through calculation and the calculation result is output, so that the positioning error caused by atmospheric interference when the signal is transmitted in the atmosphere is eliminated, and the purpose of outputting the positioning information of the high-precision label position is achieved.
Description
Technical Field
The invention relates to the technical field of ultra wide band indoor high-precision positioning, in particular to an atmospheric error processing method aiming at UWB positioning.
Background
Currently, indoor positioning is increasingly in wide demand. The UWB is a carrier-free communication technology, and uses nanosecond to microsecond non-sine wave narrow pulses to transmit data. It is called a revolutionary advance in the radio field, and is considered to become a mainstream technology of short-distance wireless communication in the future. UWB was used in the early days for near-distance high-speed data transmission, and recently, it has been used abroad to perform near-distance accurate indoor positioning by using sub-nanosecond ultra-narrow pulses.
Because the UWB-based indoor positioning method can particularly achieve the real-time centimeter-level positioning accuracy, the UWB-based indoor positioning method is widely applied to the field of indoor high-accuracy positioning.
However, when the distance between the base station and the tag is relatively long, the greatest defect that the high-precision positioning is restricted is that the distance measurement between the base station and the tag is inaccurate, which causes the positioning precision to be reduced, and is intolerable to users who need to perform real-time high-precision positioning.
In the prior art, under the condition of line of sight, the precision is reduced due to UWB real-time high-precision indoor positioning, and the interference caused by atmospheric error delay is serious when a base station and a tag are far away, so that the arrival time of a UWB signal is increased. There is no way to accurately calculate the distance between the base station and the tag.
Accordingly, there is still a need for development and improvement of the prior art.
Disclosure of Invention
The invention aims to provide an atmospheric error processing method aiming at UWB positioning, which achieves the purpose of eliminating positioning errors caused by atmospheric interference when signals are transmitted in the atmosphere, thereby outputting positioning information of a high-precision label position.
The technical purpose of the invention is realized by the following technical scheme:
an atmospheric error processing method for UWB positioning, wherein the method comprises:
the method comprises the steps that the measurement distance between a label and a base station is obtained through UWB equipment, and an observation equation is established through the measurement distance between the base station and the label;
introducing an atmospheric error parameter in the observation equation that is directly proportional to the measured distance;
the position parameters and the atmospheric error parameters are compensated and calculated by a triangulation method, so that errors caused by atmospheric interference of signal propagation in the atmosphere are eliminated;
and resolving to obtain the label position without the atmospheric error and the real-time atmospheric error parameter, and outputting a resolving result.
Further, the step of obtaining the measured distance between the tag and the base station through the UWB device, and establishing the observation equation through the measured distance between the base station and the tag further includes:
establishing a positioning coordinate system;
the location parameters include known base station coordinates and estimated initial tag coordinates.
Further, the step of performing compensation calculation on the position parameter and the atmospheric error parameter by a triangulation method so as to eliminate errors caused by atmospheric interference of signal propagation in the atmosphere specifically comprises the following steps:
performing Taylor expansion at the initial label coordinate position;
and performing recursive estimation on the position of the label by using a least square method.
Further, after the step of calculating to obtain the tag position without the atmospheric error and the real-time atmospheric error parameter and outputting the calculation result, the method further comprises:
and repeatedly carrying out Taylor expansion and least square method to solve until the precision of the position coordinates of the label reaches the preset precision requirement.
Further, the observation equation of the introduced atmospheric error parameter is:
wherein (x, y, z) represents the coordinates of the tag, (x)i,yi,zi) Coordinates of the ith base station, diRepresents the distance between the ith base station and the label, and k is an atmospheric error parameter;
the number of the base stations is at least 4.
Further, at the selected initial tag coordinate position (x)0,y0,z0) And performing Taylor series expansion, and neglecting components above the second order to obtain:
in the formula: x-x0,△y=y-y0,△z=z-z0,d0i represents the distance between the initial tag location and the ith base station.
Further, when the number of the base stations is n, introducing a matrix B ═ AX, wherein:
the matrix B represents the observed value of the ith base station, the matrix A represents the observation design matrix, and the matrix X represents the state parameter.
Further, a least squares estimate of X can be obtained by solving the equation with least squares:
thereby obtaining the position error parameters delta x, delta y and delta z and the real-time atmospheric error parameter k.
Further, the step of repeatedly performing taylor expansion and least square solving until the precision of the position coordinates of the tag reaches a preset precision requirement specifically comprises:
performing algorithm iteration, substituting the initial coordinate (x) of the label0,y0,z0) Obtaining a first set of values of Δ x, Δ y, Δ z, k, updating x at the next iteration0=x0+△x,y0=y0+△y,z0=z0And +/-Delta z, and repeating the process until the precision of the position coordinates of the label reaches the preset precision requirement.
Further, the preset precision requirement specifically includes:
presetting a threshold delta, and when the absolute delta x plus the absolute delta y plus the absolute delta z is less than or equal to the delta, obtaining position coordinates (x, y, z) which are the label positions estimated after multiple iterations.
In conclusion, the atmospheric error parameters are introduced into the observation equation, and the position parameters and the atmospheric error parameters are compensated and calculated together, so that the purpose of eliminating errors caused by atmospheric interference of signal propagation in the atmosphere and outputting high-precision positioning information of the label position is achieved.
Drawings
Fig. 1 is a flow chart of a preferred embodiment of the atmospheric error processing method for UWB positioning according to the present invention.
Detailed Description
The present invention will be described in further detail with reference to the accompanying drawings.
The present embodiment is only for explaining the present invention, and it is not limited to the present invention, and those skilled in the art can make modifications of the present embodiment without inventive contribution as needed after reading the present specification, but all of them are protected by patent law within the scope of the claims of the present invention.
Example (b): an atmospheric error processing method for UWB positioning, as shown in fig. 1, the method comprising:
s100, obtaining a measurement distance between a label and a base station through UWB equipment, and establishing an observation equation through the measurement distance between the base station and the label;
preferably, the number of the base stations is at least 4;
since the position of a point in space can be uniquely determined by the distances of 4 known points to the point, the position of the tag can be uniquely determined by the UWB device obtaining the measured distances between the tag and at least 4 base stations.
S200, introducing an atmospheric error parameter which is in direct proportion to the measured distance into the observation equation;
specifically, the observation equation with the atmospheric error parameter introduced is as follows:
wherein (x, y, z) represents the coordinates of the label, (xi, yi, z)i) Coordinates of the ith base station, diDenotes the distance of the ith base station from the tag, and k is an atmospheric error parameter.
In UWB indoor high-precision positioning, setting an atmospheric error parameter in direct proportion to a measured distance can fully meet the requirement of eliminating the atmospheric error.
S300, compensating and resolving the position parameters and the atmospheric error parameters together by a triangulation method so as to eliminate errors caused by atmospheric interference of signal propagation in the atmosphere;
the position parameters and the atmospheric error parameters are solved together by a triangulation method, so that the high-precision label position and the real-time atmospheric error parameters after atmospheric error compensation can be obtained.
And S400, resolving to obtain the label position without the atmospheric error and the real-time atmospheric error parameter, and outputting a resolving result.
Further, the step S100 previously further includes:
s001, establishing a positioning coordinate system;
the location parameters include known base station coordinates and estimated initial tag coordinates.
Specifically, a positioning coordinate system is established in the space, wherein the position parameters comprise base station coordinates and tag coordinates, the base station coordinates are known coordinate parameters, the tag coordinates are target parameters to be solved, and an estimated initial tag coordinate is set before the tag coordinates are solved.
Further, the step S300 specifically includes:
s301, performing Taylor expansion at the initial label coordinate position;
specifically, an initial tag seat is setIs marked as (x)0,y0,z0) At the selected initial tag coordinate position (x)0,y0,z0) Performing Taylor series expansion, and neglecting components above the second order:
in the formula: x-x0 and y-y0,△z=z-z0,d0iIndicating the distance between the initial tag location and the ith base station.
When the number of the base stations is n, introducing a matrix B ═ AX, wherein:
wherein (x)0,y0,z0) Is the initial position of the tag, (x)1,y1,z1)、(x2,y2,z2)、…、(xn,yn,zn) And position coordinates of base stations 1, 2, … and n are sequentially shown. d1、d2、…、dnRespectively expressed as the distance between the nth 1, 2 and … base stations and the label; d01、d02、…、d0nDenotes the distance between the nth 1, 2, … base stations and the initial position tag.
the matrix B represents an observed value of the ith base station, the matrix A represents an observation design matrix, the matrix X represents state parameters, and the number of the base stations is at least 4.
And S302, carrying out recursive estimation on the position of the label by using a least square method.
Specifically, a least squares estimate of X can be obtained by solving the equation with least squares:
thus, position error parameters delta x, delta y and delta z are obtained, wherein k obtained at the moment is the real-time atmospheric error parameter.
Further, after the step S300, the method further includes:
and S310, repeatedly carrying out Taylor expansion and least square method to solve until the precision of the position coordinates of the label reaches the preset precision requirement.
Specifically, the step S310 specifically includes:
performing algorithm iteration, substituting the initial coordinate (x) of the label0,y0,z0) Obtaining a first set of values of Δ x, Δ y, Δ z, k, updating x at the next iteration0=x0+△x,y0=y0+△y,z0=z0And +/-Delta z, and repeating the process until the precision of the position coordinates of the label reaches the preset precision requirement.
The preset precision requirement specifically comprises:
presetting a threshold delta, and when the absolute value of delta x is less than or equal to the absolute value of delta y and the absolute value of delta z is less than or equal to delta, obtaining position coordinates (x, y, z) which are the label positions estimated after multiple iterations.
In the present embodiment, the threshold Δ is preferably 30 cm. Wherein, when the threshold value delta is 30cm, the positioning precision of daily use can be ensured. In other embodiments, the threshold Δ may be set to other values according to actual needs.
In summary, the invention uses the measured distances between one tag and i (i ≧ 4) reference stations to establish an observation equation. The method comprises the steps of eliminating components with more than two orders through Taylor series expansion for linearization, resolving and obtaining a position error parameter and a real-time atmospheric error parameter at the same time according to an atmospheric error parameter which is introduced and is in direct proportion to a measured distance, and then iterating an algorithm until the precision of a label position coordinate reaches a preset precision requirement, so that errors caused by atmospheric interference of signal propagation in the atmosphere are eliminated, and finally the label position meeting a specific precision requirement is resolved.
It is to be understood that the invention is not limited to the examples described above, but that modifications and variations may be effected thereto by those of ordinary skill in the art in light of the foregoing description, and that all such modifications and variations are intended to be within the scope of the invention as defined by the appended claims.
Claims (4)
1. An atmospheric error processing method for UWB positioning, characterized in that the method comprises:
establishing a positioning coordinate system;
the method comprises the steps that the measurement distance between a label and a base station is obtained through UWB equipment, and an observation equation is established through the measurement distance between the base station and the label;
introducing an atmospheric error parameter in direct proportion to the measured distance into the observation equation, wherein the observation equation of the atmospheric error parameter in direct proportion to the measured distance is as follows:
wherein (x, y, z) represents the coordinates of the tag, (x)i,yi,zi) Coordinates of the ith base station, diRepresents the distance between the ith base station and the label, and k is an atmospheric error parameter; the number of the base stations is at least 4;
the method comprises the steps of compensating and resolving position parameters and atmospheric error parameters together by a triangulation method so as to eliminate errors caused by atmospheric interference of signal propagation in the atmosphere, wherein the position parameters comprise base station coordinates and label coordinates, the base station coordinates are known coordinate parameters, the label coordinates are target parameters to be solved, and an estimated initial label coordinate is set before the label coordinates are solved;
resolving to obtain the label position after eliminating the atmospheric error and the real-time atmospheric error parameter and outputting a resolving result;
the method for compensating and resolving the position parameters and the atmospheric error parameters together by the triangulation method so as to eliminate errors caused by atmospheric interference of signal propagation in the atmosphere comprises the following steps: performing Taylor expansion at the initial label coordinate position, and setting the initial label coordinate position as (x)0,y0,z0) At the selected initial tag coordinate position (x)0,y0,z0) Performing Taylor series expansion, and neglecting components above the second order:
in the formula: Δ x ═ x-x0,Δy=y-y0,Δz=z-z0,d0iRepresents the distance between the initial tag location and the ith base station;
when the number of the base stations is n, introducing a matrix B ═ AX, wherein:
wherein (x)1,y1,z1)、(x2,y2,z2)、...、(xn,yn,zn) Position coordinates of base stations 1, 2, 11、d2、...、dnIs denoted as the distance between the base station and the tag, d, 1, 201、d02、...、d0nMeans a distance between the nth 1, 2,. and the initial position tag;
the matrix B represents an observed value of the ith base station, the matrix A represents an observation design matrix, and the matrix X represents a state parameter;
and (3) carrying out recursive estimation on the position of the label by using a least square method:
2. The atmospheric error processing method for UWB positioning according to claim 1, wherein the step of calculating the tag position after the atmospheric error is eliminated and the atmospheric error parameter in real time and outputting the calculated result further comprises:
and repeatedly carrying out Taylor expansion and least square method to solve until the precision of the position coordinates of the label reaches the preset precision requirement.
3. The atmospheric error processing method for UWB positioning according to claim 2, wherein the step of repeatedly performing taylor expansion and least square solution until the accuracy of the tag position coordinates reaches a preset accuracy requirement specifically comprises:
the iteration of the algorithm is carried out and,substituting into the initial coordinates (x) of the tag0,y0,z0) A first set of values of Δ x, Δ y, Δ z, k is obtained, and x is updated on the next iteration0=x0+Δx,y0=y0+Δy,z0=z0And + delta z, repeating the process until the precision of the position coordinates of the label reaches the preset precision requirement.
4. The atmospheric error processing method for UWB positioning according to claim 3, wherein the preset precision requirement is specifically:
and presetting a threshold delta, wherein when the absolute value of delta x plus the absolute value of delta y plus the absolute value of delta z is less than or equal to delta, the obtained position coordinates (x, y, z) are the label positions estimated after multiple iterations.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711003347.1A CN107884745B (en) | 2017-10-24 | 2017-10-24 | Atmospheric error processing method for UWB positioning |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711003347.1A CN107884745B (en) | 2017-10-24 | 2017-10-24 | Atmospheric error processing method for UWB positioning |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107884745A CN107884745A (en) | 2018-04-06 |
CN107884745B true CN107884745B (en) | 2021-08-10 |
Family
ID=61782423
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711003347.1A Active CN107884745B (en) | 2017-10-24 | 2017-10-24 | Atmospheric error processing method for UWB positioning |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107884745B (en) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110045331A (en) * | 2019-03-08 | 2019-07-23 | 浙江亚特电器有限公司 | A kind of UWB location algorithm of real time diagnostic data failure |
CN110290463B (en) * | 2019-08-05 | 2021-03-12 | 杭州智鹍科技有限公司 | UWB base station coordinate automatic calibration method and system based on optimization theory |
CN111641919B (en) * | 2020-05-29 | 2022-07-08 | 浙江水利水电学院 | Iterative self-positioning and calibrating method for UWB (ultra wide band) base station |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101895334A (en) * | 2010-07-20 | 2010-11-24 | 上海交通大学 | Timing synchronization device based on symbol rate adaptive-interpolation and synchronization method thereof |
CN103925925A (en) * | 2014-03-14 | 2014-07-16 | 四川九洲空管科技有限责任公司 | Real-time high-precision position solution method for multilateration system |
CN106093854A (en) * | 2016-06-14 | 2016-11-09 | 江南大学 | A kind of method of air quality monitoring spot net location based on RSSI range finding |
CN106443577A (en) * | 2016-09-05 | 2017-02-22 | 北京航空航天大学 | Multi-path error detection and elimination method in allusion to inter-satellite radio frequency relative measurement |
CN107131885A (en) * | 2017-06-07 | 2017-09-05 | 西安中科光电精密工程有限公司 | A kind of indoor infrared 3D positioning measurment systems and locating measurement method |
-
2017
- 2017-10-24 CN CN201711003347.1A patent/CN107884745B/en active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101895334A (en) * | 2010-07-20 | 2010-11-24 | 上海交通大学 | Timing synchronization device based on symbol rate adaptive-interpolation and synchronization method thereof |
CN103925925A (en) * | 2014-03-14 | 2014-07-16 | 四川九洲空管科技有限责任公司 | Real-time high-precision position solution method for multilateration system |
CN106093854A (en) * | 2016-06-14 | 2016-11-09 | 江南大学 | A kind of method of air quality monitoring spot net location based on RSSI range finding |
CN106443577A (en) * | 2016-09-05 | 2017-02-22 | 北京航空航天大学 | Multi-path error detection and elimination method in allusion to inter-satellite radio frequency relative measurement |
CN107131885A (en) * | 2017-06-07 | 2017-09-05 | 西安中科光电精密工程有限公司 | A kind of indoor infrared 3D positioning measurment systems and locating measurement method |
Non-Patent Citations (3)
Title |
---|
一种基于卡尔曼滤波的超宽带室内定位算法;闫保芳等;《传感器与微***》;20171020;第36卷(第10期);第138页左栏第2段-第138页左栏第6段 * |
基于Taylor展开的UWB井下定位算法研究与实现;谢芝玉等;《计算机工程与应用》;20170115;第53卷(第2期);第232页左栏第1段-第233页右栏第1段 * |
基于总体最小二乘的泰勒级数展开的TOA的UWB定位方法;任斌等;《科学技术与工程》;20130731;第13卷(第21期);摘要,第6129页右栏第1段-6131段左栏第5段及图1 * |
Also Published As
Publication number | Publication date |
---|---|
CN107884745A (en) | 2018-04-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US9407317B2 (en) | Differential ultra-wideband indoor positioning method | |
CN107884745B (en) | Atmospheric error processing method for UWB positioning | |
CN107907857B (en) | UWB-based real-time positioning method and positioning device | |
CN110856106B (en) | Indoor high-precision three-dimensional positioning method based on UWB and barometer | |
CN107708204B (en) | UWB positioning system base station self-calibration method based on Kalman filtering | |
CN107677272B (en) | AUV (autonomous Underwater vehicle) collaborative navigation method based on nonlinear information filtering | |
CN108897013B (en) | GNSS interference source positioning method based on multi-node AGC | |
JP6843234B2 (en) | Measurement of arrival time (TOA) | |
CN103399326B (en) | GNSS (global navigation satellite system) dynamic measurement accuracy test system and method | |
CN107820206B (en) | Non-line-of-sight positioning method based on signal intensity | |
CN105547297A (en) | Indoor positioning method based on UWB positioning system | |
TWI544822B (en) | Signal strength distribution establishing method and wireless positioning system | |
CN109061559B (en) | Research method for modeling and correcting phase center deviation of UWB base station antenna | |
CN105510876A (en) | Electromagnetic wave propagation characteristic-based indoor distance measurement positioning method | |
CN103969631A (en) | System delay calibrating method and device for satellite-borne microwave radar | |
CN107371133B (en) | Method for improving positioning accuracy of base station | |
CN112394383A (en) | Satellite and 5G base station combined positioning method and device | |
CN110686681A (en) | UWB high-precision high-efficiency positioning method | |
CN109270489B (en) | Real-time continuous positioning method based on UWB (ultra Wide band) under NLOS (non line of sight) tunnel environment | |
CN106772510A (en) | A kind of frequency hopping distance-finding method based on carrier phase measurement | |
CN110554418A (en) | RTK/UWB combined mapping method and system for satellite signal shielding area | |
CN106842260B (en) | A kind of indoor orientation method based on multilayer satellite-signal repeater | |
CN111624549B (en) | Passive filtering tracking method under non-common-view condition | |
CN102288107B (en) | Ultra large geometric parameter measuring system self-calibration method based on guidance of wireless sensor network | |
CN114035182B (en) | Multi-station time difference multivariable short wave target positioning method based on ionosphere reflection |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |