CN114501300A - Distributed positioning algorithm based on space environment error model - Google Patents

Distributed positioning algorithm based on space environment error model Download PDF

Info

Publication number
CN114501300A
CN114501300A CN202111542767.3A CN202111542767A CN114501300A CN 114501300 A CN114501300 A CN 114501300A CN 202111542767 A CN202111542767 A CN 202111542767A CN 114501300 A CN114501300 A CN 114501300A
Authority
CN
China
Prior art keywords
positioning
base station
uwb
sight
information
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.)
Pending
Application number
CN202111542767.3A
Other languages
Chinese (zh)
Inventor
张昊
王庆
牛运丰
汤立凡
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Jiangsu Jicui Future City Application Technology Research Institute Co ltd
Original Assignee
Jiangsu Jicui Future City Application Technology Research Institute Co ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Jiangsu Jicui Future City Application Technology Research Institute Co ltd filed Critical Jiangsu Jicui Future City Application Technology Research Institute Co ltd
Priority to CN202111542767.3A priority Critical patent/CN114501300A/en
Publication of CN114501300A publication Critical patent/CN114501300A/en
Pending legal-status Critical Current

Links

Images

Classifications

    • HELECTRICITY
    • H04ELECTRIC COMMUNICATION TECHNIQUE
    • H04WWIRELESS COMMUNICATION NETWORKS
    • H04W4/00Services specially adapted for wireless communication networks; Facilities therefor
    • H04W4/02Services making use of location information
    • H04W4/023Services making use of location information using mutual or relative location information between multiple location based services [LBS] targets or of distance thresholds
    • HELECTRICITY
    • H04ELECTRIC COMMUNICATION TECHNIQUE
    • H04WWIRELESS COMMUNICATION NETWORKS
    • H04W4/00Services specially adapted for wireless communication networks; Facilities therefor
    • H04W4/02Services making use of location information
    • H04W4/021Services related to particular areas, e.g. point of interest [POI] services, venue services or geofences
    • HELECTRICITY
    • H04ELECTRIC COMMUNICATION TECHNIQUE
    • H04WWIRELESS COMMUNICATION NETWORKS
    • H04W4/00Services specially adapted for wireless communication networks; Facilities therefor
    • H04W4/30Services specially adapted for particular environments, situations or purposes
    • H04W4/33Services specially adapted for particular environments, situations or purposes for indoor environments, e.g. buildings

Landscapes

  • Engineering & Computer Science (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Signal Processing (AREA)
  • Position Fixing By Use Of Radio Waves (AREA)
  • Mobile Radio Communication Systems (AREA)

Abstract

The invention provides a distributed positioning algorithm based on a space environment error model. The algorithm is as follows: firstly, acquiring spatial information of a positioning environment, and acquiring a prior information graph containing line-of-sight base station distribution and a non-line-of-sight error compensation function in a positioning area by combining a known positioning environment space according to an error model of a UWB signal in a spatial structure; selecting and compensating an UWB base station in a positioning process according to a spatial prior information graph; judging whether the base station is shielded by the body of the pedestrian or not by using the course information of the PDR in the positioning process, and correcting the ranging value if the base station is shielded by the body of the pedestrian; and finally, positioning is realized by combining the compensated multi-base station information with the PDR through a distributed error state algorithm. The invention fully utilizes prior information such as a spatial structure and a UWB non-line-of-sight error model to optimize the base station to realize accurate positioning, and has the advantages of high precision and strong robustness.

Description

Distributed positioning algorithm based on space environment error model
The technical field is as follows:
the invention relates to an indoor positioning method, in particular to a distributed positioning algorithm based on a space environment error model.
Technical background:
the potential commercial value of indoor location services is rising year by year compared to outdoors. At present, stations, airports, chemical plants, hospitals, nursing homes, prisons/guard houses/drug-relief houses, construction sites and the like are introduced into indoor positioning in a large scale, and the increasing speed is very fast. Specifically, in the industry, the report of the development prospect analysis of indoor positioning in 2018 indicates that the total direct market amount of indoor positioning in China has broken through 3000 billion yuan. Currently, there are infrared, bluetooth, inertial navigation, wireless fidelity (Wi-Fi), Ultra Wide Band (UWB) technologies, and the like. UWB has emerged due to its advantages of high positioning accuracy, low power consumption, certain signal penetration, and the like, and has become an increasingly interesting technical field.
Any radio technology is inevitably flawed, and UWB technology is no exception. Ultra-wideband can reach centimetre level positioning accuracy under ideal indoor environment, but its signal transmission is easily disturbed by non-line of sight. Because the transmission distance of the UWB signal in the room is limited, and the signal of the UWB signal generates a large error when the UWB signal bypasses an obstacle, the UWB signal cannot be used in an NLOS scene or an indoor scene having a blind area. The general idea to solve this problem is to combine inertial navigation technology with UWB technology. The accuracy of the position fix can be improved to a certain extent, but the range error in the case of non-line-of-sight UWB is not solved essentially, especially because the presence of non-line-of-sight measurements will enlarge the position fix error. Therefore, the invention makes full use of the environment information and the UWB space propagation error model, and provides a distributed positioning algorithm based on the space environment error model, thereby fundamentally solving the non-line-of-sight error of the UWB caused by the space environment characteristics.
The invention content is as follows:
the invention provides a distributed positioning algorithm based on a space environment error model. The algorithm is as follows: firstly, acquiring spatial information of a positioning environment, arranging a UWB positioning base station in the positioning space, and acquiring a prior information graph containing line-of-sight base station distribution and a non-line-of-sight error compensation function in a positioning area by combining a known positioning environment space according to an error model of a UWB signal in a spatial structure; selecting UWB base stations in the positioning process according to the spatial prior information graph, only selecting line-of-sight base stations when the number of line-of-sight base stations is more than 3, and performing error compensation on non-line-of-sight base stations according to an error function when the number of line-of-sight base stations is less than 3; and in the positioning process, the shielding error of the pedestrian body is compensated by combining the course information of the PDR, and finally, the positioning is realized by combining the compensated multi-base-station information with the PDR. The invention fully utilizes prior information such as a spatial structure and a UWB non-line-of-sight error model to optimize the base station to realize accurate positioning, and has the advantages of high precision and strong robustness.
The technical solution for realizing the invention is as follows: a distributed positioning algorithm based on a space environment error model comprises the following steps:
s1, acquiring environmental space information of a positioning area, and laying a positioning base station;
s2, establishing a positioning environment UWB station-building line-of-sight or non-line-of-sight information distribution map;
s3, establishing a positioning environment prior information graph by using a non-line-of-sight error compensation function and combining the distribution situation of the base stations in the S2;
s4, selecting the UWB base station in the positioning process;
s5, carrying out error compensation on the base station under the influence of the human body by using a human body error compensation function;
s6, establishing a dynamic distributed error filtering algorithm;
s7, taking the current positioning result obtained in S6 as the positioning starting point of the next moment and feeding back the positioning starting point to the PDR for information correction;
further, the establishing of the positioning environment prior information map in step 3 is specifically as follows:
firstly, scanning and positioning a regional space environment through laser radar equipment, and establishing a regional space model according to laser point cloud; carrying out UWB base station deployment according to PDOP optimization criterion and space environment; dividing the ground into square small squares with the side length of 0.5 meter in a space model, traversing each small square in the area, adding base station number information with visible distance into each small square, and obtaining a base station visible distance environment map; fitting a distance and angle related signal propagation error function by a ranging experiment aiming at a UWB base station signal propagation shielding barrier in a space environment; calculating an error value in a non-line-of-sight environment of the base station at the central point of each small square grid, storing the corresponding number and the error value of the base station into the base station line-of-sight environment graph established in the last step, and finally establishing an environment prior information graph; each small square in the information graph comprises a line-of-sight base station number and a non-line-of-sight base station number, and a ranging error compensation value under the condition that the position point is not in line-of-sight aiming at the non-line-of-sight base station.
Further, the selection strategy for the UWB positioning base station in step 4 is specifically as follows:
the UWB positioning algorithm needs to acquire the position data of at least three base stations, and the real-time position of the dynamic tag is acquired through a triangulation method.
On the basis of the positioning position at the previous moment, the position of the UWB mobile station at the current moment is pre-judged by using a filtering state prediction equation and the course information of the PDR, the positioning base stations are selected by combining the UWB station building sight distance or non sight distance information distribution diagram established by S2, and when the visual base stations at the estimation point are more than or equal to three, only the sight distance positioning base stations are selected for positioning; when the estimated point visible distance base stations are less than three, according to the step S3, a total of three base stations including the visible distance base station and the non-visible distance base station with a relatively weak non-visible distance condition are selected as the positioning base stations.
Further, a method for judging the strength of the non-line-of-sight condition of the non-line-of-sight base station specifically comprises the following steps: and judging according to the error function fitted by the non-line-of-sight base station in the S3, and sequencing according to the magnitude of the error values.
Further, in step 5, the error compensation is performed on the base station under the influence of the human body by using the human body error compensation function, specifically as follows:
and calculating the direction angle information of the selected base station and the human body in the S4 according to the position point at the current moment and the space position information of the base station by using the advancing course information acquired in the PDR positioning, judging whether the selected base station is influenced by the human body shielding, and performing error compensation on the influenced base station by adopting a human body influence error function.
Further, the establishing of the dynamic distributed error filtering algorithm in step 6 specifically includes the following steps:
the measurement information is obtained by using the difference between RTT (round trip time) ranging information of UWB (ultra-wideband) and PDR (packet data radio) positioning; using UWB measured value as PDR positioning constraint to update PDR information;
the state equation is:
Figure BDA0003414741090000021
Figure BDA0003414741090000022
Figure BDA0003414741090000023
wherein the content of the first and second substances,
Figure BDA0003414741090000024
is the state vector of the carrier at time k,
Figure BDA0003414741090000025
the position quantities of the PDR in both directions of the water surface at time k,
Figure BDA0003414741090000031
is the amount of velocity corresponding to the horizontal position of the PDR at time k,
Figure BDA0003414741090000032
the course angle of PDR at the moment k; a (k) is the acceleration of PDR at time k; f is a state matrix;
Figure BDA0003414741090000033
process noise that is a state;
the measurement equation is as follows:
Figure BDA0003414741090000034
wherein Z (k) is measurement information,. DELTA.d1,kSelecting the number of UWB base stations for a distributed measurement equation, wherein n is the positioning point, H is a measurement matrix, and v (k) is measurement noise;
Figure BDA0003414741090000035
Figure BDA0003414741090000036
wherein the content of the first and second substances,
Figure BDA0003414741090000037
the distance between the UWB tag and the ith UWB reference station calculated by the PDR at the k moment;
Figure BDA0003414741090000038
position coordinates in the east-west direction at time k are located for the PDR,
Figure BDA0003414741090000039
positioning position coordinates of the PDR in the north-south direction at the moment k;
Figure BDA00034147410900000310
for the UWB ith fixed base station position coordinates in the east-west direction,
Figure BDA00034147410900000311
position coordinates in the north-south direction of the ith UWB fixed base station under the condition of line of sight
Figure BDA00034147410900000312
And
Figure BDA00034147410900000313
for direct range values, in the case of non-line-of-sight
Figure BDA00034147410900000314
And
Figure BDA00034147410900000315
the distance value after the error function correction is combined;
Figure BDA00034147410900000316
distance between UWB mobile station and ith fixed base station;
and solving the modified measurement equation and the state equation according to the steps of the EKF to obtain the optimal estimation value of the state quantity, and further calculating to obtain the optimal estimation value of the UWB mobile base station.
Compared with the prior art, the invention has the following remarkable advantages:
(1) the method comprises the steps of fully utilizing environment prior information, obtaining a prior information graph containing line-of-sight base station distribution and a non-line-of-sight error compensation function in a positioning area by combining a known positioning environment space according to an error model of a UWB signal in a space structure;
(2) the UWB positioning base station is optimized according to the environmental characteristics, the line-of-sight base station is used for positioning, and when the line-of-sight base station is not enough to complete positioning, the non-line-of-sight base station is subjected to ranging compensation and then positioning;
(3) and combining the compensated multi-base station information with the PDR to realize positioning through a distributed error state algorithm, and acquiring high-precision positioning information.
Description of the drawings:
FIG. 1 is a schematic diagram of the algorithm
FIG. 2 UWB station-building line-of-sight or non-line-of-sight information distribution diagram
FIG. 3 is a diagram of UWB station building local line-of-sight information
FIG. 4 is a diagram of UWB station building local non-line-of-sight information and error compensation
FIG. 5 PDR pedestrian dead reckoning map
FIG. 6 distributed Algorithm Block diagram
The specific implementation mode is as follows:
the following description will explain embodiments of the present invention in further detail with reference to the accompanying drawings. The general algorithm principle of the invention is shown in fig. 1, and a distributed positioning algorithm based on a space environment error model comprises the following steps: s1, acquiring environmental space information of a positioning area, and laying a positioning base station; s2, establishing a positioning environment UWB station-building line-of-sight or non-line-of-sight information distribution map; s3, establishing a positioning environment prior information graph by using a non-line-of-sight error compensation function and combining the distribution situation of the base stations in the S2; s4, selecting the UWB base station in the positioning process; s5, carrying out error compensation on the base station under the influence of the human body by using a human body error compensation function; s6, establishing a dynamic distributed error filtering algorithm to obtain a final positioning result; and S7, taking the current positioning result obtained in S6 as the positioning starting point of the next time and feeding back the positioning starting point to the PDR for information correction.
The first embodiment is as follows: establishing a sight distance and non-sight distance information graph of a positioning base station specifically as follows:
firstly, scanning and positioning a regional space environment through laser radar equipment, and establishing a regional space model according to laser point cloud; carrying out UWB base station deployment according to PDOP optimization criterion and space environment; as shown in fig. 2, which is a simple schematic diagram, base stations are 0 and 1, the ground is divided into square small squares with a side length of 0.5 m in a spatial model, each small square in an area is traversed, visible-distance base station number information is added to the small squares, and a base station visible-distance environment diagram is obtained, as shown in fig. 3, the numbers of the visible-distance base stations are contained in the squares; fitting a distance and angle related signal propagation error function by a ranging experiment aiming at a UWB base station signal propagation shielding barrier in a space environment; calculating an error value in a non-line-of-sight environment of the base station at the central point of each small square grid, storing a corresponding number and the error value of the base station into a base station line-of-sight environment graph established in the previous step, and finally establishing an environment prior information graph, wherein the number of the non-line-of-sight base station and a ranging compensation value under an error model are contained in the square grid as shown in fig. 4; each small square in the information graph comprises a line-of-sight base station number and a non-line-of-sight base station number, and a ranging error compensation value under the condition that the position point is not in line-of-sight aiming at the non-line-of-sight base station.
The second embodiment: the UWB positioning model is concretely as follows:
the UWB positioning system mainly comprises more than or equal to three fixed base stations and a mobile station, and the distance between the base station and the tag is obtained by utilizing wireless communication two-way ranging, and the formula is as follows:
d=c*TTOF (1)
Figure BDA0003414741090000041
in the formula: d represents the distance of the tag from the base station,
Figure BDA0003414741090000042
TTOT represents the time taken from the sending of data by the positioning tag to the reception of the corresponding reply data transmitted by the base station, TTATRepresenting the time between receipt of data by the positioning base station and transmission of a response data packet, TTOFRepresenting the time consumed by the data in the propagation process.
After the distance between the base station and the tag is obtained through TOF two-way ranging, the position of the tag is located by using a trilateration method, taking three base stations as an example, assuming A1, A2 and A3 as three locating base stations, taking the base stations as the circle centers, taking the measured distance between the tag and the base stations as the radius to make a circle, and the coordinate positions of the base stations are (x) respectively1,y1),(x2,y2),(x3,y3) Ideally, the three circles made in the ideal case intersect at a point O, the intersection point O is the location label position, and assuming that the coordinates of the intersection point O are (x, y), the label position calculation formula is as follows:
Figure BDA0003414741090000043
Figure BDA0003414741090000044
and solving by adopting a least square optimization method, and performing optimization solving by minimizing the error function to obtain the label coordinate. The error function has various forms, and one of the expression methods is:
Figure BDA0003414741090000051
assuming that the coordinates to be solved are (x ', y'), this can be obtained by minimizing the objective function E (x, y):
(x ', y') -argminE (x, y) (6) embodiment three: the pedestrian dead reckoning PDR model specifically comprises the following steps:
the PDR estimates the step length of the pedestrian and the direction of each step by using the raw data of the inertial sensor, thereby achieving the purpose of positioning and tracking the pedestrian. The principle of the PDR algorithm is shown in FIG. 5, and the track recurrence formula is shown in the formula
Figure BDA0003414741090000052
X, Y are x-axis and y-axis coordinates, SL is the step length, and theta is the heading angle, i.e. the included angle between the moving direction and the x-axis.
The PDR algorithm generally comprises 3 parts: gait detection, step length estimation and heading calculation.
(1) Gait detection
The method comprises the steps of judging by adopting acceleration data in an inertia device, setting an acceleration wave crest threshold value, detecting an acceleration value at the moment k for the first time, comparing the acceleration value with adjacent k +1 and k-1 to judge whether the acceleration value is a peak value, comparing the acceleration value at the current moment judged as the peak value with the set acceleration threshold value, counting steps when the acceleration value is greater than the threshold value, and judging as noise disturbance when the acceleration value is less than the threshold value.
(2) Step size estimation
For the step-size estimation, a non-linear step-size estimation model is used, i.e.
Figure BDA0003414741090000053
In the formula: a is amaxAnd aminC is a calibration constant, wherein c is the maximum value and the minimum value in the acceleration data in the kth step time range in the gait detection result.
(3) Course calculation
Course calculation is mainly completed by a magnetometer and a gyroscope, initial course is determined through output of the magnetometer, and direction change amount is determined by the gyroscope. The earth is a dipolar magnet with a fixed north-pointing magnetic component, and the orientation of the inertial positioning node can be determined by measuring the projection of this component on three axes using a magnetometer. Integrating the angular velocity values allows the calculation of the angle change.
The fourth embodiment is as follows: establishing a distributed filtering algorithm state and a measurement equation specifically comprises the following steps:
a block diagram of a distributed filtering algorithm is shown in fig. 6, in which the measurement information is obtained by using the difference between RTT ranging information of UWB and PDR positioning; using UWB measured value as PDR positioning constraint to update PDR information;
the state equation is:
Figure BDA0003414741090000054
Figure BDA0003414741090000055
Figure BDA0003414741090000061
wherein the content of the first and second substances,
Figure BDA0003414741090000062
is the state vector of the carrier at time k,
Figure BDA0003414741090000063
the position quantities of the PDR in both directions of the water surface at time k,
Figure BDA0003414741090000064
is the amount of velocity corresponding to the horizontal position of the PDR at time k,
Figure BDA0003414741090000065
the course angle of PDR at the moment k; a (k) is the acceleration of PDR at time k; f is a state matrix;
Figure BDA0003414741090000066
process noise that is a state;
the measurement equation is:
Figure BDA0003414741090000067
wherein Z (k) is measurement information,. DELTA.d1,kFor the distributed measurement equation, n is the number of UWB base stations selected for the anchor point, H is the measurement matrix, u (k) is the measurement noise;
Figure BDA0003414741090000068
Figure BDA0003414741090000069
wherein the content of the first and second substances,
Figure BDA00034147410900000610
the distance between the UWB tag and the ith UWB reference station calculated by the PDR at the k moment;
Figure BDA00034147410900000611
position coordinates in the east-west direction at time k are located for the PDR,
Figure BDA00034147410900000612
positioning position coordinates of the PDR in the north-south direction at the moment k;
Figure BDA00034147410900000613
for the UWB ith fixed base station position coordinates in the east-west direction,
Figure BDA00034147410900000614
position coordinates in the north-south direction of the ith UWB fixed base station under the condition of line of sight
Figure BDA00034147410900000615
And
Figure BDA00034147410900000616
for direct range values, in the case of non-line-of-sight
Figure BDA00034147410900000617
And
Figure BDA00034147410900000618
the distance value after the error function correction is combined;
Figure BDA00034147410900000619
the distance between the UWB mobile station and the ith fixed base station;
and solving the modified measurement equation and the state equation according to the steps of the EKF to obtain the optimal estimation value of the state quantity, and further calculating to obtain the optimal estimation value of the UWB mobile base station.
The invention provides a distributed positioning algorithm based on a space environment error model. The algorithm is as follows: firstly, acquiring spatial information of a positioning environment, and acquiring a prior information graph containing line-of-sight base station distribution and a non-line-of-sight error compensation function in a positioning area by combining a known positioning environment space according to an error model of a UWB signal in a spatial structure; selecting and compensating errors of the UWB base station in the positioning process according to the spatial prior information map; judging whether the base station is shielded by the body of the pedestrian or not by using the course information of the PDR in the positioning process, and correcting the ranging value if the base station is shielded by the body of the pedestrian; and finally, positioning is realized by combining the compensated multi-base station information with the PDR through a distributed error state algorithm. The invention fully utilizes the prior information such as a space structure, a UWB non-line-of-sight error model and the like to optimize the base station to realize accurate positioning, and compared with the prior art, the invention has the remarkable advantages that: (1) the method comprises the steps of fully utilizing environment prior information, obtaining a prior information graph containing line-of-sight base station distribution and a non-line-of-sight error compensation function in a positioning area by combining a known positioning environment space according to an error model of a UWB signal in a space structure; (2) the UWB positioning base station is optimized according to the environmental characteristics, the line-of-sight base station is used for positioning, and when the line-of-sight base station is not enough to complete positioning, the non-line-of-sight base station is subjected to ranging compensation and then positioning; (3) and combining the compensated multi-base station information with the PDR to realize positioning through a distributed error state algorithm, and acquiring high-precision positioning information.

Claims (6)

1. A distributed positioning algorithm based on a space environment error model is characterized by comprising the following steps:
s1, acquiring environmental space information of a positioning area, and laying a positioning base station;
s2, establishing a UWB station-building sight distance or non-sight distance information distribution map in a positioning environment;
s3, establishing a positioning environment prior information graph by using a non-line-of-sight error compensation function and combining the distribution situation of the base stations in the S2;
s4, selecting the UWB base station in the positioning process;
s5, carrying out error compensation on the base station under the influence of the human body by using a human body error compensation function;
s6, establishing a dynamic distributed error filtering algorithm;
and S7, taking the current positioning result obtained in S6 as the positioning starting point of the next time and feeding back the positioning starting point to the PDR for information correction.
2. The distributed positioning algorithm based on the spatial environment error model according to claim 1, wherein the step 3 of establishing the positioning environment prior information map specifically includes the following steps:
firstly, scanning and positioning a regional space environment through laser radar equipment, and establishing a regional space model according to laser point cloud; carrying out UWB base station deployment according to PDOP optimization criterion and space environment; dividing the ground into square small squares with the side length of 0.5 meter in a space model, traversing each small square in the area, adding base station number information with visible distance into each small square, and obtaining a base station visible distance environment map; fitting a distance and angle related signal propagation error function by a ranging experiment aiming at a UWB base station signal propagation shielding barrier in a space environment; calculating an error value in a non-line-of-sight environment of the base station at the central point of each small square grid, storing the corresponding number and the error value of the base station into the base station line-of-sight environment graph established in the last step, and finally establishing an environment prior information graph; each small square in the information graph comprises a line-of-sight base station number and a non-line-of-sight base station number, and a ranging error compensation value under the condition that the position point is not in line-of-sight aiming at the non-line-of-sight base station.
3. The distributed positioning algorithm based on the spatial environment error model according to claim 1, wherein the selection strategy for the UWB positioning base station in step 4 is as follows:
the UWB positioning algorithm needs to acquire the position data of at least three base stations, and the real-time position of the dynamic tag is acquired through a triangulation method.
On the basis of the positioning position at the previous moment, the position of the UWB mobile station at the current moment is pre-judged by using a filtering state prediction equation and the course information of the PDR, the positioning base stations are selected by combining the UWB station building sight distance or non-sight distance information distribution diagram established by S2, and when the visual base stations at the estimation point are more than or equal to three, only the sight distance positioning base stations are selected for positioning; when the estimated point visible distance base stations are less than three, according to the step S3, a total of three base stations including the visible distance base station and the non-visible distance base station with a relatively weak non-visible distance condition are selected as the positioning base stations.
4. According to the selection strategy for the UWB positioning base station, the method for judging the strength of the non-line-of-sight condition of the non-line-of-sight base station is characterized in that the method comprises the following specific steps: and judging according to the error function fitted by the non-line-of-sight base station in the S3, and sequencing according to the magnitude of the error values.
5. The distributed positioning algorithm based on the spatial environment error model according to claim 1, wherein the error compensation is performed on the base station under the influence of the human body by using the human body error compensation function in step 5, specifically as follows:
and calculating the direction angle information of the selected base station and the human body in the S4 according to the position point at the current moment and the space position information of the base station by using the advancing course information acquired in the PDR positioning, judging whether the selected base station is influenced by the human body shielding, and performing error compensation on the influenced base station by adopting a human body influence error function.
6. The distributed positioning algorithm based on the spatial environment error model according to claim 1, wherein the dynamic distributed error filtering algorithm established in step 6 specifically includes the following steps:
the measurement information is obtained by using the difference between RTT (round trip time) ranging information of UWB (ultra-wideband) and PDR (packet data radio) positioning; using UWB measured value as PDR positioning constraint to update PDR information;
the state equation is:
Figure FDA0003414741080000021
Figure FDA0003414741080000022
Figure FDA0003414741080000023
wherein the content of the first and second substances,
Figure FDA0003414741080000024
is the state vector of the carrier at time k,
Figure FDA0003414741080000025
the position quantities of the PDR in both directions of the water surface at time k,
Figure FDA0003414741080000026
is the amount of velocity corresponding to the horizontal position of the PDR at time k,
Figure FDA0003414741080000027
the course angle of PDR at the moment k; a (k) is the acceleration of PDR at time k; f is a state matrix;
Figure FDA0003414741080000028
process noise that is a state;
the measurement equation is as follows:
Figure FDA0003414741080000029
wherein Z (k) is measurement information,. DELTA.d1,kSelecting the number of UWB base stations for a distributed measurement equation, wherein n is a positioning point, H is a measurement matrix, and upsilon (k) is measurement noise;
Figure FDA00034147410800000210
Figure FDA00034147410800000211
wherein the content of the first and second substances,
Figure FDA00034147410800000212
the distance between the UWB tag and the ith UWB reference station calculated by the PDR at the k moment;
Figure FDA00034147410800000213
position coordinates in the east-west direction at time k are located for the PDR,
Figure FDA00034147410800000214
positioning position coordinates of the PDR in the north-south direction at the moment k;
Figure FDA00034147410800000215
for the UWB ith fixed base station position coordinates in the east-west direction,
Figure FDA00034147410800000216
for the ith fixed base station of UWBPosition coordinates in north-south direction, in line of sight
Figure FDA00034147410800000217
And
Figure FDA00034147410800000218
for direct range values, in the case of non-line-of-sight
Figure FDA00034147410800000219
And
Figure FDA00034147410800000220
the distance value after the error function correction is combined;
Figure FDA00034147410800000221
distance between UWB mobile station and ith fixed base station;
and solving the modified measurement equation and the state equation according to the steps of the EKF to obtain the optimal estimation value of the state quantity, and further calculating to obtain the optimal estimation value of the UWB mobile base station.
CN202111542767.3A 2021-12-16 2021-12-16 Distributed positioning algorithm based on space environment error model Pending CN114501300A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202111542767.3A CN114501300A (en) 2021-12-16 2021-12-16 Distributed positioning algorithm based on space environment error model

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202111542767.3A CN114501300A (en) 2021-12-16 2021-12-16 Distributed positioning algorithm based on space environment error model

Publications (1)

Publication Number Publication Date
CN114501300A true CN114501300A (en) 2022-05-13

Family

ID=81493655

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202111542767.3A Pending CN114501300A (en) 2021-12-16 2021-12-16 Distributed positioning algorithm based on space environment error model

Country Status (1)

Country Link
CN (1) CN114501300A (en)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116299167A (en) * 2022-07-07 2023-06-23 广东师大维智信息科技有限公司 Elongated space positioning method, computer readable storage medium and computer device
CN116582818A (en) * 2023-07-06 2023-08-11 中国科学院空天信息创新研究院 Non-line-of-sight effect compensation indoor positioning method based on UWB ranging
CN116939815A (en) * 2023-09-15 2023-10-24 常熟理工学院 UWB positioning base station selection method based on laser point cloud map
CN117545070A (en) * 2024-01-09 2024-02-09 宁波市阿拉图数字科技有限公司 UWB high-precision positioning method suitable for indoor shielding environment

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116299167A (en) * 2022-07-07 2023-06-23 广东师大维智信息科技有限公司 Elongated space positioning method, computer readable storage medium and computer device
CN116582818A (en) * 2023-07-06 2023-08-11 中国科学院空天信息创新研究院 Non-line-of-sight effect compensation indoor positioning method based on UWB ranging
CN116939815A (en) * 2023-09-15 2023-10-24 常熟理工学院 UWB positioning base station selection method based on laser point cloud map
CN116939815B (en) * 2023-09-15 2023-12-05 常熟理工学院 UWB positioning base station selection method based on laser point cloud map
CN117545070A (en) * 2024-01-09 2024-02-09 宁波市阿拉图数字科技有限公司 UWB high-precision positioning method suitable for indoor shielding environment
CN117545070B (en) * 2024-01-09 2024-04-02 宁波市阿拉图数字科技有限公司 UWB high-precision positioning method suitable for indoor shielding environment

Similar Documents

Publication Publication Date Title
Yang et al. A novel NLOS error compensation method based IMU for UWB indoor positioning system
CN105547305B (en) A kind of pose calculation method based on wireless location and laser map match
CN114501300A (en) Distributed positioning algorithm based on space environment error model
CN103402258B (en) Wi-Fi (Wireless Fidelity)-based indoor positioning system and method
TWI503560B (en) Vehicle position calibration method and apparatus
CN102419180B (en) Indoor positioning method based on inertial navigation system and WIFI (wireless fidelity)
US9234965B2 (en) Indoor positioning using pressure sensors
CN101191832B (en) Wireless sensor network node position finding process based on range measurement
Johnson et al. Ultra-wideband aiding of GPS for quick deployment of anchors in a GPS-denied ad-hoc sensor tracking and communication system
CN110856106B (en) Indoor high-precision three-dimensional positioning method based on UWB and barometer
CN105004340A (en) Inertial navigation-fingerprint location-combined positioning error correction method
US20180262880A1 (en) Altitude-based indoor or outdoor detection
CN204166130U (en) Radio frequency locating device and system
US20150309183A1 (en) Method of estimating the position of a device
CN104181500A (en) Real-time locating method based on inertia information and chance wireless signal characteristics
CN103096462A (en) Non-ranging node locating method of wireless sensor network
Toth et al. Positioning slow-moving platforms by UWB technology in GPS-challenged areas
Lategahn et al. Tdoa and rss based extended kalman filter for indoor person localization
Xu et al. Bluetooth, floor-plan, and microelectromechanical systems-assisted wide-area audio indoor localization system: Apply to smartphones
Si et al. An adaptive weighted Wi-Fi FTM-based positioning method in an NLOS environment
KR101135201B1 (en) A rssi based location measurement method and system using acceleration location information in the wireless network
EP2856199A1 (en) Determining location and orientation of directional tranceivers
JP2007533968A5 (en)
CN108332749B (en) Indoor dynamic tracking and positioning method
CN115774238A (en) Improved coal mine underground personnel positioning algorithm

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