The present disclosure relates to the field of communications, and in particular, to a positioning method, an electronic device, a computer-readable storage medium and a positioning system.
With the continuous development of wireless technology, wireless technology has been used for ranging/positioning between devices, but wireless electromagnetic waves are easily affected by environmental factors, such as temperature and humidity, electromagnetic interference, metal shielding, wall obstruction or human influence, which will have a great impact on wireless signals, such as wireless signals are greatly attenuated or produces reflection, diffraction, etc., so that a propagation speed of an electromagnetic wave signal in air is changed, thereby increasing a flight time of the electromagnetic wave signal in air, delaying radio signals, resulting in a large deviation between a measurement result and a true value, and further occurring non line of sight (NLOS) phenomenon. Ultra wide band (UWB) is a centimeter-level wireless positioning device, and in a serious NLOS environment, the measurement error will even exceed a meter level. In actual use process, many factors will cause NLOS phenomenon, but this influence cannot be directly avoided, and current UWB devices in the NLOS environment have poor positioning accuracy.
The main objective of the present disclosure is to provide a positioning method, an electronic device, a computer-readable storage medium and a positioning system, to solve the problem in the related technologies of poor positioning accuracy of UWB devices.
According to an aspect of embodiments of the present disclosure, a positioning method is provided, including: obtaining an integrated signal strength and a first-path signal strength, where the integrated signal strength is determined according to strengths of a plurality of signals sent by a sending device, and the first-path signal strength is a strength of the first signal received by a receiving device; obtaining an initial distance value between the sending device and the receiving device, and an initial position information of the sending device; determining a correction distance value according to the integrated signal strength and the first-path signal strength, and correcting the initial distance value by using the correction distance value, to obtain a target distance value; and correcting the initial position information according to the target distance value, to obtain a target position information.
Optionally, the obtaining an initial distance value between the sending device and the receiving device includes: obtaining a first difference value between the integrated signal strength and the first-path signal strength; and determining the initial distance value between the sending device and the receiving device according to the first difference value.
Optionally, the determining the initial distance value between the sending device and the receiving device according to the first difference value includes: when the first difference value is smaller than a first threshold value, obtaining a first timestamp, a second timestamp, a clock frequency offset and a propagation speed of electromagnetic wave, where the first timestamp refers to a timestamp for sending a data packet by the sending device, and the second timestamp refers to a timestamp for receiving the data packet by the receiving device; determining an actual time consumption according to the first timestamp, the second timestamp and the clock frequency offset, where the actual time consumption refers to a time actually consumed for the data packet to be sent from the sending device to the receiving device; and determining the initial distance value between the sending device and the receiving device according to the actual time consumption and the propagation speed of electromagnetic wave.
Optionally, the method further includes: when the first difference value is greater than or equal to the first threshold value, determining that a signal corresponding to the integrated signal strength and a signal corresponding to the first-path signal strength are both invalid signals.
Optionally, the integrated signal strength includes a first-type integrated signal strength and a second-type integrated signal strength, the first-path signal strength includes a first-type first-path signal strength and a second-type first-path signal strength, and the first-type integrated signal strength and the first-type first-path signal strength are obtained in a first scene, the second-type integrated signal strength and the second-type first-path signal strength are obtained in a second scene, where the first scene refers to a scene in which there is no obstruction between the sending device and the receiving device, and the second scene refers to a scene in which there is an obstruction between the sending device and the receiving device, the determining a correction distance value according to the integrated signal strength and the first-path signal strength includes: obtaining a second difference value between the first-type integrated signal strength and the second-type integrated signal strength; obtaining a third difference value between the first-type first-path signal strength and the second-type first-path signal strength; and determining the correction distance value according to the second difference value and the third difference value.
Optionally, the determining the correction distance value according to the second difference value and the third difference value includes: when the second difference value is smaller than a second threshold value, and the third difference value is smaller than or equal to a third threshold value, determining that the correction distance value is a first correction distance value; when the second difference value is smaller than the second threshold value, the third difference value is greater than the third threshold value, and the third difference value is smaller than a fourth threshold value, determining that the correction distance value is a second correction distance value, where the fourth threshold value is greater than the third threshold value, and the second correction distance value is greater than the first correction distance value; and when the second difference value is greater than or equal to the second threshold value and smaller than a fifth threshold value, and the third difference value is greater than the third threshold value and smaller than the fourth threshold value, determining that the correction distance value is a third correction distance value, where the fifth threshold value is greater than the second threshold value, and the third correction distance value is greater than the second correction distance value.
Optionally, the determining the correction distance value according to the second difference value and the third difference value further includes: when the second difference value is greater than or equal to the fifth threshold value, and the third difference value is greater than the third threshold value and smaller than the fourth threshold value, determining that the correction distance value is a fourth correction distance value, where the fourth correction distance value is greater than the third correction distance value; when the second difference value is greater than or equal to the second threshold value and smaller than the fifth threshold value, and the third difference value is greater than or equal to the fourth threshold value, determining that the correction distance value is a fifth correction distance value, where the fifth correction distance value is greater than the fourth correction distance value; and when the second difference value is greater than or equal to the fifth threshold value and the third difference value is greater than or equal to the fourth threshold value, determining that the correction distance value is a sixth correction distance value, where the sixth correction distance value is greater than the fifth correction distance value.
Optionally, the correcting the initial position information according to the target distance value, to obtain a target position information includes: determining a current state of the sending device, where the current state is obtained by using a gyroscope sensor, the gyroscope sensor is installed in the sending device, and the current state includes a static state and a motion state; and when the current state is the motion state, correcting the initial position information according to the target distance value, to obtain the target position information.
Optionally, the when the current state is the motion state, correcting the initial position information according to the target distance value, to obtain the target position information includes: obtaining a first initial position information at a first moment and a second initial position information at a second moment; determining whether an actual distance value is equal to the target distance value, where the actual distance value is a distance value of the second initial position information of the sending device relative to a position information of the receiving device; and when the actual distance value is not equal to the target distance value, correcting the second initial position information according to the first initial position information at the first moment and the second initial position information at the second moment, to obtain the target position information.
Optionally, when the motion state is a linear motion status and the actual distance value is not equal to the target distance value, the correcting the second initial position information according to the first initial position information at the first moment and the second initial position information at the second moment, to obtain the target position information includes: constructing a first function relationship by using a plurality of the first initial position information at the first moment and the second initial position information at the second moment; and correcting the second initial position information according to the first function relationship, to obtain the target position information.
Optionally, when the motion state is a non-linear motion status and the actual distance value is not equal to the target distance value, the correcting the second initial position information according to the first initial position information at the first moment and the second initial position information at the second moment, to obtain the target position information includes: determining whether an actual direction is the same as a target direction, where the actual direction refers to a direction of the second initial position information of the sending device relative to the position information of the receiving device; when the actual direction is different from the target direction, obtaining a correction slope parameter and a turning angle parameter; constructing a second function relationship by using the first initial position information at a plurality of the first moment, the second initial position information at the second moment, the correction slope parameter and the turning angle parameter; and correcting the second initial position information according to the second function relationship, to obtain the target position information.
Optionally, the positioning method further includes: when the current state is the static state, determining not to correct the initial position information; and continuously obtaining the initial position information at a plurality of moments, obtaining an average value of a plurality of initial position information, and determining the average value as the target position information.
Optionally, the correcting the initial distance value by using the correction distance value, to obtain a target distance value includes: obtaining a fourth difference value between the initial distance value and the correction distance value; and determining the fourth difference value as the target distance value.
Optionally, the sending device includes a first UWB device, and the receiving device includes a second UWB device.
According to another aspect of the embodiments of the present disclosure, a positioning apparatus is further provided, including: a first obtaining unit, configured to obtain an integrated signal strength and a first-path signal strength, wherein the integrated signal strength is determined according to strengths of a plurality of signals sent by a sending device, and the first-path signal strength is a strength of the first signal received by a receiving device; a second obtaining unit, configured to obtain an initial distance value between the sending device and the receiving device, and an initial position information of the sending device; a first determination unit, configured to determine a correction distance value according to the integrated signal strength and the first-path signal strength, and correct the initial distance value by using the correction distance value, to obtain a target distance value; and a correction unit, configured to correct the initial position information according to the target distance value, to obtain a target position information.
According to still another aspect of the embodiments of the present disclosure, a computer-readable storage medium is further provided, including a stored program, which executes any one of the methods.
According to yet another aspect of the embodiments of the present disclosure, a positioning system is also provided, including a sending device, a receiving device and a positioning device, where the positioning device communicates with the sending device and the receiving device respectively, and the positioning device is configured to execute any one of the methods.
In the positioning method of the present disclosure, obtaining the integrated signal strength and the first-path signal strength at first, then obtaining the initial distance value between the sending device and the receiving device, and the initial position information of the sending device, next determining the correction distance value according to the integrated signal strength and the first-path signal strength, and correcting the initial distance value by using the correction distance value, to obtain the target distance value, and finally correcting the initial position information according to the target distance value, to obtain the target position information. In this solution, the position information of the sending device is corrected through multiple steps in NLOS environment, which may correct the position information and navigation route of the sending device in the NLOS environment, and therefore reducing the influence degree of the positioning of the sending device in the NLOS environment, further improving positioning accuracy of the sending device in the NLOS environment. Meanwhile, the solution can reduce the deviation of the radio communication ranging or positioning position, so that the measurement value in the NLOS environment is closer to the actual value.
The accompanying drawings, which constitute a part of the present disclosure, are used to provide a further understanding of the present disclosure, and the illustrative embodiments of the present disclosure and the description thereof are used to explain the present disclosure and do not constitute an improper limitation on the present disclosure.
It should be noted that, in the case of no conflict, embodiments in the present disclosure and features in the embodiments may be combined with each other. The following describes the present disclosure in detail with reference to the accompanying drawings and in combination with the embodiments.
In order to enable a person of ordinary skill in the art to better understand the solutions of the present disclosure, the following clearly describes the technical solutions in the embodiments of the present disclosure with reference to the accompanying drawings in the embodiments of the present disclosure. Apparently, the described embodiments are a part rather than all of the embodiments of the present disclosure. All other embodiments obtained by a person of ordinary skill in the art based on the embodiments of the present disclosure without creative efforts shall fall within the protection scope of the present disclosure.
It should be noted that, the terms “first”, “second” and the like in the specification, claims, and accompanying drawings of the present disclosure are used to distinguish similar objects, and are not necessarily used to describe a specific order or sequence. It should be understood that the data used in this way may be interchanged under appropriate circumstances, to facilitate the embodiments of the present disclosure described herein. In addition, the terms “including”, “comprising” and any variations thereof are intended to cover a non-exclusive inclusion, for example, a process, method, system, product or device that includes a series of steps or units is not necessarily limited to those steps or units listed clearly, but may include other steps or units that are not clearly listed or inherent to such process, method, product or device.
It should be understood that, when an element (such as a layer, film, region, or substrate) is described as being “on” another element, the element may be directly on the other element or intervening elements may be present between them. Moreover, in the specification and the claims, when an element is described as being “connected” to another element, the element may be “directly connected” to the other element, or “connected” to the other element by using a third element.
As described in the background, in the related technologies, UWB devices have poor positioning accuracy, and in order to solve the above problem, embodiments of the present disclosure provide a positioning method, a positioning apparatus, a computer-readable storage medium and a positioning system.
According to an embodiment of the present disclosure, a positioning method is provided.
S101, obtaining an integrated signal strength and a first-path signal strength, wherein the integrated signal strength is determined according to strengths of a plurality of signals sent by a sending device, and the first-path signal strength is a strength of the first signal received by a receiving device.
S102, obtaining an initial distance value between the sending device and the receiving device, and an initial position information of the sending device.
S103, determining a correction distance value according to the integrated signal strength and the first-path signal strength, and correcting the initial distance value by using the correction distance value, to obtain a target distance value.
S104, correcting the initial position information according to the target distance value, to obtain a target position information.
Specifically, the sending device includes a UWB device. The solution is applicable to positioning of a UWB device in an NLOS environment. In this way, correction is performed through multiple steps in NLOS environment, which may correct position information and navigation route of the UWB device in the NLOS environment, and therefore reducing an influence degree of the positioning of the UWB device in the NLOS environment, further improving positioning accuracy of the UWB device in the NLOS environment. Meanwhile, the solution can reduce a deviation of radio communication ranging or positioning position, so that a measurement value in the NLOS environment is closer to an actual value.
In the above method, firstly, obtaining the integrated signal strength and the first-path signal strength, then obtaining the initial distance value between the sending device and the receiving device, and the initial position information of the sending device, next determining the correction distance value according to the integrated signal strength and the first-path signal strength, and correcting the initial distance value by using the correction distance value, to obtain the target distance value, and finally correcting the initial position information according to the target distance value, to obtain the target position information. In this solution, the position information of the sending device is corrected through multiple steps in NLOS environment, which may correct the position information and navigation route of the sending device in the NLOS environment, and therefore reducing the influence degree of the positioning of the sending device in the NLOS environment, further improving positioning accuracy of the sending device in the NLOS environment. Meanwhile, the solution can reduce the deviation of the radio communication ranging or positioning position, so that the measurement value in the NLOS environment is closer to the actual value.
It should be noted that steps shown in the flowcharts of the accompanying drawings may be executed in a computer system such as a set of computer executable instructions, and although a logical order is shown in the flowcharts, in some cases, the steps shown or described may be executed in an order different from that described herein.
Specifically, in an actual application, the sending device of the present solution is shown in
In addition, the UWB circuit further includes a UWB chip from decawave company, the chip has a function of reading the integrated signal strength and the first-path signal strength in the signal transmission process and may be set a threshold value of an effective received signal strength to 13, so that an influence of the NLOS environment and an influence of environmental noise under the UWB device can be balanced. When the sending device is in a motion status, correction may be performed in the ranging process according to the integrated signal strength and the first-path signal strength during an information interaction process, where the integrated signal strength mainly reflects the quality of all signals in the entire receiving process. Specifically, it may be an average value of all received signals or a predetermined signal strength which may be greater than 80% of the signal strength of all signals, and the first-path signal strength mainly reflects the received signal strength of the first signal arrived at a receiving end, whether the transmitted signal has been reflected and been affected by the NLOS environment may be determined according to the integrated signal strength and the first-path signal strength, and a greater difference value between the two signal strengths indicates the worse NLOS environment.
In some embodiments of the present disclosure, the obtaining an initial distance value between the sending device and the receiving device includes: obtaining a first difference value between the integrated signal strength and the first-path signal strength; and determining the initial distance value between the sending device and the receiving device according to the first difference value. In this embodiment, the first difference value may indicate whether reflection occurs in a process of transmitting a signal between the sending device and the receiving device and the signal has been affected by the NLOS environment, so that the initial distance value between the sending device and the receiving device may be more accurately determined according to the first difference value.
In some other embodiments of the present disclosure, the determining the initial distance value between the sending device and the receiving device according to the first difference value includes: when the first difference value is smaller than a first threshold value, obtaining a first timestamp, a second timestamp, a clock frequency offset and a propagation speed of electromagnetic wave, where the first timestamp refers to a timestamp for sending a data packet by the sending device, and the second timestamp refers to a timestamp for receiving the data packet by the receiving device; determining an actual time consumption according to the first time stamp, the second time stamp and the clock frequency offset, where the actual time consumption refers to a time actually consumed for the data packet to be sent form the sending device to the receiving device; and determining the initial distance value between the sending device and the receiving device according to the actual time consumption and the propagation speed of electromagnetic wave. In this embodiment, the actual time consumption may be accurately determined by using the first timestamp, the second timestamp and the clock frequency offset, so that the initial distance value between the sending device and the receiving device may be further accurately determined according to the actual time consumption and the propagation speed of electromagnetic wave.
Specifically, as shown in
where t represents the actual time consumption, rtd_init represents the first timestamp, rtd_resp represents the second timestamp, fclockOffset represents the clock frequency offset, and then the initial distance value is calculated by using the following formula: d=t×c, where d represents the initial distance value, c represents the propagation speed of electromagnetic wave. Only the measured initial distance value is less affected by the NLOS environment or is in the LOS environment, it may be used as a data input of TOF position algorithm.
In some other embodiments of the present disclosure, the above method further includes: when the first difference value is greater than or equal to the first threshold value, determining that a signal corresponding to the integrated signal strength and a signal corresponding to the first-path signal strength are both invalid signals. In this embodiment, when the first difference value between the integrated signal strength and the first-path signal strength is greater than or equal to the first threshold value, the two signals are considered to be invalid signals, so that data severely affected by the NLOS environment can be screened out, to obtain data in the LOS environment or data less affected by the NLOS environment, and therefore reducing the influence of the NLOS environment on positioning. Generally, distance measurement may be performed between the sending device and the nearest receiving device, to reduce an environmental influence degree on signal quality, if a severe NLOS environment occurs at a relatively close distance, the receiving device at a longer distance needs to be replaced, to reduce the influence of the NLOS environment. This embodiment can filter the data in the NLOS environment.
In some other embodiments of the present disclosure, the integrated signal strength includes a first-type integrated signal strength and a second-type integrated signal strength, the first-path signal strength includes a first-type first-path signal strength and a second-type first-path signal strength, and the first-type integrated signal strength and the first-type first-path signal strength are obtained in a first scene, the second-type integrated signal strength and the second-type first-path signal strength are obtained in a second scene, where the first scene refers to a scene in which there is no obstruction between the sending device and the receiving device, and the second scene refers to a scene in which there is an obstruction between the sending device and the receiving device. The determining a correction distance value according to the integrated signal strength and the first-path signal strength includes: obtaining a second difference value between the first-type integrated signal strength and the second-type integrated signal strength; obtaining a third difference value between the first-type first-path signal strength and the second-type first-path signal strength; and determining the correction distance value according to the second difference value and the third difference value. In this embodiment, although the data severely affected by the NLOS environment has been filtered out before, a data less affected by the NLOS environment may also exist. As the distance between the sending device and the receiving device varies, the interference that occurs or the degree affected by the NLOS environment is also different, and therefore parameters of the first scene (i.e., the LOS environment) and parameters of the second scene (i.e., the NLOS environment) may be used to determine whether reflection has occurred, and further a function curve may be constructed by using the first-type integrated signal strength and the first-type first-path signal strength, which may be used as a reference data for comparison with the second-type integrated signal strength and the second-type first-path signal strength, to determine the correction distance value more accurately.
To further accurately determine the correction distance value, in some other embodiments of the present disclosure, the determining the correction distance value according to the second difference value and the third difference value includes: when the second difference value is smaller than a second threshold value, and the third difference value is smaller than or equal to a third threshold value, determining that the correction distance value is a first correction distance value; when the second difference value is smaller than the second threshold value, the third difference value is greater than the third threshold value, and the third difference value is smaller than a fourth threshold value, determining that the correction distance value is a second correction distance value, where the fourth threshold value is greater than the third threshold value, and the second correction distance value is greater than the first correction distance value; and when the second difference value is greater than or equal to the second threshold value and smaller than a fifth threshold value, and the third difference value is greater than the third threshold value and smaller than the fourth threshold value, determining that the correction distance value is a third correction distance value, where the fifth threshold value is greater than the second threshold value, and the third correction distance value is greater than the second correction distance value.
To further accurately determine the correction distance value, in some other embodiments of the present disclosure, the determining the correction distance value according to the second difference value and the third difference value further includes: when the second difference value is greater than or equal to the fifth threshold value, and the third difference value is greater than the third threshold value and smaller than the fourth threshold value, determining that the correction distance value is a fourth correction distance value, where the fourth correction distance value is greater than the third correction distance value; when the second difference value is greater than or equal to the second threshold value and smaller than the fifth threshold value, and the third difference value is greater than or equal to the fourth threshold value, determining that the correction distance value is a fifth correction distance value, where the fifth correction distance value is greater than the fourth correction distance value; and when the second difference value is greater than or equal to the fifth threshold value and the third difference value is greater than or equal to the fourth threshold value, determining that the correction distance value is a sixth correction distance value, where the sixth correction distance value is greater than the fifth correction distance value.
Specifically, in a first scene, the first-type integrated signal strength is denoted as RX_level(x), the first-type first-path signal strength is denoted as First_level(x), and x is the measurement distance (x=0˜100 m). Generally, an initial distance value in the NLOS environment may be greater than an initial distance value in the actual situation (ranging from 10 cm to 2 m), but generally not smaller. If a signal strength in a second scene is smaller than a signal strength in the first scene, it means that there is occlusion. The second-type integrated signal strength in the second scene is denoted as A(x), the second-type first-path signal strength is B(x), whether a reflection is generated, an error analysis of the initial distance value L, and a correction distance value has the following cases.
In a first case: A(x)−RX_level(x)<0.5 db, and B(x)−First_level(x)≤0.5 db, it represents in a LOS environment, a received signal is slightly occluded or non-occluded, the received signal is a direct signal, a distance error err=0, and a correction distance value LK is 0.
In a second case: A(x)−RX_level(x)<0.5 db, and 5<[B(x)−First_level(x)]<10 db, it represents in a general NLOS environment, a received signal is generally occluded, a determination signal is a direct signal, and a measurement error is mainly caused by a relatively slow propagation speed of the electromagnetic wave when encountering a transmission medium. Through multiple measurements, it can be found that in the second case, the strength of the received signal and the distance error have greater influence factors, A(x)−RX_level(x) can be used as a correction factor, the distance error is increased by about 10 cm to 30 cm, and a correction distance value LK=50A(x)−RX_level(x), LK<30 cm.
In a third case: 0.5≤(A(x)−RX_level(x))<6 db, and 5<[B(x)−First_level(x)]<10 db, it represents in a relatively serious NLOS environment, a received signal is seriously occluded, a distance error is increased by about 20 cm to 60 cm, but the signal is still a direct signal, and a correction distance value LK=20A(x)−RX_level(x), LK<60 cm.
In a fourth case: ((A(x)−RX_level(x))≥6 db, and 5<[B(x)−First_level(x)]<10 db, it represents in a very serious NLOS environment, a received signal is extremely seriously occluded, a distance error is increased by about 80 cm or more, but the signal is still may be a direct signal, and a correction distance value LK=15[A(x)−RX_level(x)], LK<100 cm.
In a fifth case: 0.5≤(A(x)−RX_level(x))<6 db, and [B(x)−First_level(x)]≥10 db, it represents in a relatively serious NOS environment, a received signal is seriously occluded, a distance error is increased by about 50 cm to 100 cm. It has a great probability that the received signal is a reflection signal, a correction distance value LK=5[A(x)−RX_level(x)]+[B(x)−First_level(x)], LK<150 cm.
In a sixth case: (A(x)−RX_level(x))≥6 db, and [B(x)−First_level(x)]≥10 db, it represents in a severe NLOS environment, a received signal is seriously occluded, a distance error is increased by about 100 cm or more, the received signal is a reflected signal, and a correction distance value LK=10[A(x)−B(x)], LK<200 cm.
In some specific embodiments of the present disclosure, the correcting the initial position information according to the target distance value, to obtain the target position information includes: determining a current state of the sending device, where the current state is obtained by using a gyroscope sensor which is installed in the sending device, and the current state includes a static state and a motion state; and when the current state is the motion state, correcting the initial position information according to the target distance value, to obtain the target position information. In this embodiment, the initial position information may be further corrected, the gyroscope sensor has a good feedback effect on position and direction, and therefore the gyroscope sensor may be used to correct the initial position information, to make the output target position information is closer to the actual situation, so that an error fluctuation is reduced.
In some other embodiments of the present disclosure, the when the current state is the motion state, correcting the initial position information according to the target distance value, to obtain the target position information includes: obtaining a first initial position information at a first moment and a second initial position information at a second moment; determining whether an actual distance value is equal to the target distance value, where the actual distance value is a distance value of the second initial position information of the sending device relative to position information of the receiving device; and when the actual distance value is not equal to the target distance value, correcting the second initial position information according to the first initial position information at the first moment and the second initial position information at the second moment, to obtain the target position information. In this embodiment, the initial position information may be further corrected, to ensure the obtained target position information is more accurate, further improving the positioning accuracy of the sending device in the NLOS environment.
In some still other embodiments of the present disclosure, when the motion state is a linear motion status and the actual distance value is not equal to the target distance value, the correcting the second initial position information according to the first initial position information at the first moment and the second initial position information at the second moment, to obtain the target position information includes: constructing a first function relationship by using a plurality of the first initial position information at the first moment and the second initial position information at the second moment; and correcting the second initial position information according to the first function relationship, to obtain the target position information. In this embodiment, when the motion state is a linear motion status, the initial position information may be further corrected, to ensure the obtained target position information is more accurate, further improving the positioning accuracy of the sending device in the NLOS environment.
In some embodiments, a schematic diagram of correction in a linear motion status is as shown in
A triangle enclosed by t2, t3 and t4 is obtained according to a triangular formula:
simplified results:
According to Formula 1 and Formula 2:
When it is detected that an attitude angle is offset to left,
When it is detected that the attitude angle is offset to right,
Therefore, the obtained target position information is (x3,y4), and the initial position information of each positioning is correspondingly corrected, so that the measured navigation route is closer to the actual situation.
In some other specific embodiments of the present disclosure, when the motion state is a non-linear motion status and the actual distance value is not equal to the target distance value, the correcting the second initial position information according to the first initial position information at the first moment and the second initial position information at the second moment, to obtain the target position information includes: determining whether an actual direction is the same as a target direction, where the actual direction refers to a direction of the second initial position information of the sending device relative to the position information of the receiving device; when the actual direction is different from the target direction, obtaining a correction slope parameter and a turning angle parameter; constructing a second function relationship by using the first initial position information at a plurality of the first moment, the second initial position information at the second moment, the correction slope parameter and the turning angle parameter; and correcting the second initial position information according to the second function relationship, to obtain the target position information. In this embodiment, when the motion state is a non-linear motion state, the initial position information may be further corrected, to ensure the obtained target position information is more accurate, further improving the positioning accuracy of the sending device in the NLOS environment.
In some embodiments, a schematic diagram of correction in a non-linear motion state is shown in
A linear equation composed of t2 and t4 is y=mx+n, the slope of the equation is:
In addition, since the linear equation passes through t2, then y2=mx2+n, that is, n=y2−mx2, therefore the equation is:
The triangle enclosed by t2, t3 and t4 is obtained according to the triangular formula:
simplified results:
According to Formula 6 and Formula 8:
Angle A is an angle of the measured rotation angle preliminarily calculated through the TOF algorithm. Assuming that a distance between t1 and t2 is dc, an distance between t1 and t3 is da, an distance between t2 and t3 is db, and it is obtained in Δt1t2t3:
Then, the calculated angle A of the measured rotation angle is:
When A>θ, a corrected target position information is:
When A<θ, a corrected target position information is:
To further accurately determine the target position information, in some other embodiments of the present disclosure, the method further includes: when the current state is the static state, determining not to correct the initial position information; continuously obtaining the initial position information at a plurality of moments, calculating an average value of a plurality of initial position information, and determining the average value as the target position information.
Specifically, in the static state, since an error of each measurement still exists, the position information of calculation and measurement still has a slight fluctuation, which is difficult to be visible by visual perception. The gyroscope sensor may be used for continuous positioning in the static state, the obtained distance values are 5.001 cm, 4.999 cm and 5.002 cm respectively, and an average value of the three data is taken as the target position information, so that a display effect is closer to the real value without slight fluctuation.
In some still other embodiments of the present disclosure, the correcting the initial distance value by using the correction distance value, to obtain a target distance value includes: obtaining a fourth difference value between the initial distance value and the correction distance value; and determining the fourth difference value as the target distance value. In this embodiment, when the correction distance value has been determined, the fourth difference value between the initial distance value and the correction distance value is determined as the target distance value, further accurately determining the target distance value between the sending device and the receiving device.
In some embodiments of the present disclosure, the sending device includes a first UWB device, and the receiving device includes a second UWB device. In this way, a positioning position of the UWB device in the NLOS environment may be calculated.
An embodiment of the present disclosure further provides a positioning apparatus. It should be noted that the positioning apparatus in the embodiments of the present disclosure may be configured to perform the positioning method provided in the embodiments of the present disclosure. The following describes the positioning apparatus provided in the embodiments of the present disclosure.
The first obtaining unit 10 is configured to obtain an integrated signal strength and a first-path signal strength, where the integrated signal strength is determined according to strengths of a plurality of signals sent by a sending device, and the first-path signal strength is a strength of the first signal received by a receiving device.
The second obtaining unit 20 is configured to obtain an initial distance value between the sending device and the receiving device, and an initial position information of the sending device.
The first determination unit 30 is configured to determine a correction distance value according to the integrated signal strength and the first-path signal strength, and correct the initial distance value by using the correction distance value, to obtain a target distance value.
The correction unit 40 is configured to correct the initial position information according to the target distance value, to obtain a target position information.
Specifically, the sending device includes a UWB device. The solution is applicable to positioning of a UWB device in an NLOS environment. In this way, correction is performed through multiple steps in NLOS environment, which may correct position information and navigation route of the UWB device in the NLOS environment, and therefore reducing an influence degree of the positioning of the UWB device in the NLOS environment, further improving positioning accuracy of the UWB device in the NLOS environment. Meanwhile, the solution can reduce a deviation of radio communication ranging or positioning position, so that a measurement value in the NLOS environment is closer to an actual value.
In the above apparatus, the first obtaining unit obtains the integrated signal strength and the first-path signal strength firstly, then the second obtaining unit obtains the initial distance value between the sending device and the receiving device, and the initial position information of the sending device, next the first determination unit determines the correction distance value according to the integrated signal strength and the first-path signal strength, and correcting the initial distance value by using the correction distance value to obtain the target distance value, and the correction unit corrects the initial position information according to the target distance value to obtain the target position information at last. In this solution, the position information of the sending device is corrected through multiple steps in NLOS environment, which may correct the position information and navigation route of the sending device in the NLOS environment, and therefore reducing the influence degree of the positioning of the sending device in the NLOS environment, further improving positioning accuracy of the sending device in the NLOS environment. Meanwhile, the solution can reduce the deviation of the radio communication ranging or positioning position, so that the measurement value in the NLOS environment is closer to the actual value.
In some embodiments of the present disclosure, the second obtaining unit includes a first obtaining module and a first determination module, where the first obtaining module is configured to obtain a first difference value between the integrated signal strength and the first-path signal strength; and the first determination module is configured to determine the initial distance value between the sending device and the receiving device according to the first difference value. In this embodiment, the first difference value may indicate whether reflection occurs in a process of transmitting a signal between the sending device and the receiving device and the signal has been affected by the NLOS environment, so that the initial distance value between the sending device and the receiving device may be more accurately determined according to the first difference value.
In some still other embodiments of the present disclosure, the first determination module includes a first obtaining sub-module, a first determination sub-module and a second determination sub-module, and the first obtaining sub-module is configured to: when the first difference value is smaller than a first threshold value, obtain a first timestamp, a second timestamp, a clock frequency offset and a propagation speed of electromagnetic wave, where the first timestamp refers to a timestamp for sending a data packet by the sending device, and the second timestamp refers to a timestamp for receiving the data packet by the receiving device; the first determination sub-module is configured to: determine an actual time consumption according to the first time stamp, the second time stamp and the clock frequency offset, where the actual time consumption refers to a time actually consumed for the data packet to be sent form the sending device to the receiving device; and the second determination sub-module is configured to: determine the initial distance value between the sending device and the receiving device according to the actual time consumption and the propagation speed of electromagnetic wave. In this embodiment, the actual time consumption may be accurately determined by using the first timestamp, the second timestamp and the clock frequency offset, so that the initial distance value between the sending device and the receiving device may be further accurately determined according to the actual time consumption and the propagation speed of electromagnetic wave.
In some yet other embodiments of the present disclosure, the apparatus further includes a second determination unit, configured to: when the first difference value is greater than or equal to the first threshold value, determine that a signal corresponding to the integrated signal strength and a signal corresponding to the first-path signal strength are both invalid signals. In this embodiment, when the first difference value between the integrated signal strength and the first-path signal strength is greater than or equal to the first threshold value, the two signals are considered to be invalid signals, so that data severely affected by the NLOS environment can be screened out, to obtain data in the LOS environment or data less affected by the NLOS environment, and therefore reducing the influence of the NLOS environment on positioning. Generally, distance measurement may be performed between the sending device and the nearest receiving device, to reduce an environmental influence degree on signal quality, if a severe NLOS environment occurs at a relatively close distance, the receiving device at a longer distance needs to be replaced, to reduce the influence of the NLOS environment. This embodiment can filter the data in the NLOS environment.
In some other embodiments of the present disclosure, the integrated signal strength includes a first-type integrated signal strength and a second-type integrated signal strength, the first-path signal strength includes a first-type first-path signal strength and a second-type first-path signal strength, and the first-type integrated signal strength and the first-type first-path signal strength are obtained in a first scene, the second-type integrated signal strength and the second-type first-path signal strength are obtained in a second scene, where the first scene refers to a scene in which there is no obstruction between the sending device and the receiving device, and the second scene refers to a scene in which there is an obstruction between the sending device and the receiving device. The first determination unit includes a second obtaining module, a third obtaining module and a second determination module, where the second obtaining module is configured to: obtain a second difference value between the first-type integrated signal strength and the second-type integrated signal strength; the third obtaining module is configured to: obtain a third difference value between the first-type first-path signal strength and the second-type first-path signal strength; and the second determination module is configured to: determine the correction distance value according to the second difference value and the third difference value. In this embodiment, although the data severely affected by the NLOS environment has been filtered out before, a data less affected by the NLOS environment may also exist. As the distance between the sending device and the receiving device varies, the interference that occurs or the degree affected by the NLOS environment is also different, and therefore parameters of the first scene (i.e., the LOS environment) and parameters of the second scene (i.e., the NLOS environment) may be used to determine whether reflection has occurred, and further a function curve may be constructed by using the first-type integrated signal strength and the first-type first-path signal strength, which may be used as a reference data for comparison with the second-type integrated signal strength and the second-type first-path signal strength, to determine the correction distance value more accurately.
To further accurately determine the correction distance value, in some other embodiments of the present disclosure, the second determination module includes a third determination sub-module, a fourth determination sub-module and a fifth determination sub-module, and the third determination sub-module is configured to: when the second difference value is smaller than a second threshold value, and the third difference value is smaller than or equal to a third threshold value, determine that the correction distance value is a first correction distance value; the fourth determination sub-module is configured to: when the second difference value is smaller than the second threshold value, the third difference value is greater than the third threshold value, and the third difference value is smaller than a fourth threshold value, determine that the correction distance value is a second correction distance value, where the fourth threshold value is greater than the third threshold value, and the second correction distance value is greater than the first correction distance value; and the fifth determination sub-module is configured to: when the second difference value is greater than or equal to the second threshold value and smaller than a fifth threshold value, and the third difference value is greater than the third threshold value and smaller than the fourth threshold value, determine the correction distance value is a third correction distance value, where the fifth threshold value is greater than the second threshold value, and the third correction distance value is greater than the second correction distance value.
To further accurately determine the correction distance value, in some other embodiments of the present disclosure, the second determination module includes a sixth determination sub-module, a seventh determination sub-module and an eighth determination sub-module, and the sixth determination sub-module is configured to: when the second difference value is greater than or equal to the fifth threshold value, and the third difference value is greater than the third threshold value and smaller than the fourth threshold value, determine the correction distance value is a fourth correction distance value, where the fourth correction distance value is greater than the third correction distance value; the seventh determination sub-module is configured to: when the second difference value is greater than or equal to the second threshold value and smaller than the fifth threshold value, and the third difference value is greater than or equal to the fourth threshold value, determine the correction distance value is a fifth correction distance value, where the fifth correction distance value is greater than the fourth correction distance value; and the eighth determination sub-module is configured to: when the second difference value is greater than or equal to the fifth threshold value and the third difference value is greater than or equal to the fourth threshold value, determine that the correction distance value is a sixth correction distance value, where the sixth correction distance value is greater than the fifth correction distance value.
In a specific embodiment of the present disclosure, the correction unit includes a third determination module and a correction module, and the third determination module is configured to: determine a current state of the sending device, where the current state is obtained by using a gyroscope sensor, the gyroscope sensor is installed in the sending device, and the current state includes a static state and a motion state; the correction module is configured to: when the current state is the motion state, correct the initial position information according to the target distance value, to obtain target position information. In this embodiment, the initial position information may be further corrected, the gyroscope sensor has a good feedback effect on position and direction, and therefore the gyroscope sensor may be used to correct the initial position information, to make the output target position information is closer to the actual situation, so that an error fluctuation is reduced.
In another specific embodiment of the present disclosure, the correction module includes a second obtaining sub-module, a ninth determination sub-module and a correction sub-module, and the second obtaining sub-module is configured to: obtain a first initial position information at a first moment and a second initial position information at a second moment, the ninth determination sub-module is configured to: determine whether an actual distance value is equal to the target distance value, where the actual distance value is a distance value of the second initial position information of the sending device relative to position information of the receiving device; and the correction sub-module is configured to: when the actual distance value is not equal to the target distance value, correct the second initial position information according to the first initial position information at the first moment and the second initial position information at the second moment, to obtain the target position information. In this embodiment, the initial position information may be further corrected, to ensure the obtained target position information is more accurate, further improving the positioning accuracy of the sending device in the NLOS environment.
In yet another specific embodiment of the present disclosure, when the motion state is a linear motion status, the correction sub-module is further configured to: construct a first function relationship by using a plurality of the first initial position information at the first moment and the second initial position information at the second moment; and the correction sub-module is further configured to: correct the second initial position information according to the first function relationship, to obtain the target position information. In this embodiment, when the motion state is a linear motion status, the initial position information may be further corrected, to ensure the obtained target position information is more accurate, further improving the positioning accuracy of the sending device in the NLOS environment.
In yet another specific embodiment of the present disclosure, when the motion state is a non-linear motion status, the correction sub-module is further configured to: determine whether an actual direction is the same as a target direction, where the actual direction refers to a direction of the second initial position information of the sending device relative to the position information of the receiving device; the correction sub-module is further configured to: when the actual direction is different from the target direction, obtain a correction slope parameter and a turning angle parameter; the correction sub-module is further configured to: construct a second function relationship by using the first initial position information at a plurality of the first moment, the second initial position information at the second moment, the correction slope parameter and the turning angle parameter; and the correction sub-module is further configured to: correct the second initial position information according to the second function relationship, to obtain the target position information. In this embodiment, when the motion state is a non-linear motion state, the initial position information may be further corrected, to ensure the obtained target position information is more accurate, further improving the positioning accuracy of the sending device in the NLOS environment.
To further accurately determine the target position information, in some other embodiments of the present disclosure, the apparatus further includes a third determination unit and a processing unit, and the third determination unit is configured to: when the current state is the static state, determine not to correct the initial position information; and the processing unit is configured to: continuously obtain the initial position information at a plurality of moments, calculate an average value of a plurality of initial position information, and determine the average value as the target position information.
Specifically, in the static state, since an error of each measurement still exists, the position information of calculation and measurement still has a slight fluctuation, which is difficult to be visible by visual perception. The gyroscope sensor may be used for continuous positioning in the static state, the obtained distance values are 5.001 cm, 4.999 cm and 5.002 cm respectively, and an average value of the three data is taken as the target position information, so that a display effect is closer to the real value without slight fluctuation.
In some other embodiments of the present disclosure, the first determination unit includes a fourth obtaining module and a fourth determination module, and the fourth obtaining module is configured to: obtain a fourth difference value between the initial distance value and the correction distance value; and the fourth determination module is configured to: determine the fourth difference value as the target distance value. In this embodiment, when the correction distance value has been determined, the fourth difference value between the initial distance value and the correction distance value is determined as the target distance value, further accurately determining the target distance value between the sending device and the receiving device.
In some embodiments of the present disclosure, the sending device includes a first UWB device, and the receiving device includes a second UWB device. In this way, a positioning position of the UWB device in the NLOS environment may be calculated.
The positioning apparatus includes a processor and a memory, where the first obtaining unit, the second obtaining unit, the first determination unit, the correction unit, etc. are all stored in the memory as program units, and the processor executes the program units stored in the memory to implement corresponding functions.
The processor includes a kernel used to call a corresponding program unit from the memory. The kernel may be set one or more, and the positioning of the UWB device in the NLOS environment may be accurately calculated by adjusting the kernel parameter.
The memory may include a non-persistent memory in a computer-readable storage medium, may be a random access memory (RAM), a non-volatile memory, or a random access memory (RAM) and a non-volatile memory, etc., for example, a read-only memory (ROM) or a flash RAM, and the memory includes at least one storage chip.
An embodiment of the present disclosure provides a computer-readable storage medium, on which a program is stored, and when the program is executed by a processor, the foregoing positioning method is implemented.
An embodiment of the present disclosure provides a processor which is configured to run a program, and when the program is run, the foregoing positioning method is executed.
The present disclosure further provides a positioning system, including a sending device, a receiving device and a positioning apparatus, where the positioning apparatus communicates with the sending device and the receiving device respectively, where the positioning apparatus is configured to perform any one of the above methods.
In the above system, since any one of the foregoing methods is included, the method first obtains the integrated signal strength and the first-path signal strength, then obtains the initial distance value between the sending device and the receiving device, and the initial position information of the sending device, next determines the correction distance value according to the integrated signal strength and the first-path signal strength, and corrects the initial distance value by using the correction distance value, to obtain the target distance value, and finally corrects the initial position information according to the target distance value, to obtain the target position information. In this solution, the position information of the sending device is corrected through multiple steps in NLOS environment, which may correct the position information and navigation route of the sending device in the NLOS environment, and therefore reducing the influence degree of the positioning of the sending device in the NLOS environment, further improving positioning accuracy of the sending device in the NLOS environment. Meanwhile, the solution can reduce the deviation of the radio communication ranging or positioning position, so that the measurement value in the NLOS environment is closer to the actual value.
An embodiment of the present disclosure provides a device, including a processor, a memory, and a program stored in the memory and executable on the processor, where when the processor executes the program, at least the following steps are implemented.
S101, obtaining an integrated signal strength and a first-path signal strength, where the integrated signal strength is determined according to strengths of a plurality of signals sent by a sending device, and the first-path signal strength is a strength of the first signal received by a receiving device.
S102, obtaining an initial distance value between the sending device and the receiving device, and an initial position information of the sending device.
S103, determining a correction distance value according to the integrated signal strength and the first-path signal strength, and correcting the initial distance value by using the correction distance value, to obtain a target distance value.
S104, correcting the initial position information according to the target distance value, to obtain a target position information.
The device herein may be a server, a PC, a PAD, a mobile phone, etc.
The present disclosure further provides a computer program product, which, when executed on a data processing device, is adapted to execute a program for initializing at least the following method steps:
In order to make the technical solutions of the present disclosure be more clearly understood for a person skilled in the art, the following will describe the technical solutions and technical effects of the present disclosure with reference to specific embodiments.
The embodiment relates to a positioning method, as shown in
An implementation of the solution may be established on a hardware, mainly including a UWB circuit, an MCU processor, a PA+LNA+SW high-power circuit, a six-axis acceleration sensor circuit and a processor.
Screening a measurement value is to take a signal with a first difference value, between the integrated signal strength and the first-path signal strength, greater than or equal to a first threshold as a relatively serious NLOS measurement distance, and perform filter to obtain a LOS or low-impact NLOS measurement distance.
Correcting the measurement value is to perform different correction calculations on initial distance values in different degrees of NLOS.
Correcting a coordinate is to use an angular increment of the gyroscope sensor to feedback and correct the initial coordinate value in real time.
Determining whether an angle change exceeds 5°, if so, perform a non-linear motion correction method; and if not, perform a linear motion correction method.
In some embodiments provided in the present disclosure, it should be understood that the disclosed technical content may be implemented in other manners. The apparatus embodiments described above are merely illustrative, for example, a division of the foregoing units may be a logical function division, and in actual implementation, there may be another division manner. For example, a plurality of units or components may be combined or integrated into another system, or some features may be ignored or not performed. In addition, the shown or discussed coupling or direct coupling or communication connection may be accomplished through indirect coupling or communication connection between some interfaces, devices or units, or may be electrical, mechanical, or in other forms.
The units described as separate parts may or may not be physically separate, and components shown as units may or may not be physical units, that is, may be located in one position, or may be distributed on a plurality of units. According to actual necessity, part or all of the units may be selected to achieve an objective of the solutions of the embodiments.
In addition, functional units in the embodiments of the present disclosure may be integrated into one processing unit, or each of the units may exist alone physically or two or more units are integrated into one unit. The integrated unit may be implemented in a form of hardware, or may be implemented in a form of a software functional unit.
If the integrated unit is implemented in the form of software functional unit and sold or used as an independent product, it may be stored in a computer-readable storage medium. Based on such understanding, the technical solutions of the present disclosure or the part that makes contribution to relevant technology, or all of the technical solutions, may be embodied in the form of a software product, the computer software product is stored in a storage medium, and includes several instructions for making a computer device (may be a personal computer, a server, a network device, etc.) to perform all or part of the steps of the above method in the embodiments of the present disclosure. The above storage medium includes a medium that can store program code, such as a U disk, a read-only memory (ROM), a random access memory (RAM), a portable hard disk, a magnetic disk, or an optical disk.
From the above description, it can be seen that the above embodiments of the present disclosure achieve the following technical effects.
Firstly, in the positioning method of the present disclosure, obtaining the integrated signal strength and the first-path signal strength at first, then obtaining the initial distance value between the sending device and the receiving device, and the initial position information of the sending device, next determining the correction distance value according to the integrated signal strength and the first-path signal strength, and correcting the initial distance value by using the correction distance value, to obtain the target distance value, and finally correcting the initial position information according to the target distance value, to obtain the target position information. In this solution, the position information of the sending device is corrected through multiple steps in NLOS environment, which may correct the position information and navigation route of the sending device in the NLOS environment, and therefore reducing the influence degree of the positioning of the sending device in the NLOS environment, further improving positioning accuracy of the sending device in the NLOS environment. Meanwhile, the solution can reduce the deviation of the radio communication ranging or positioning position, so that the measurement value in the NLOS environment is closer to the actual value.
Secondly, the positioning apparatus of the present disclosure, the first obtaining unit obtains the integrated signal strength and the first-path signal strength firstly, then the second obtaining unit obtains the initial distance value between the sending device and the receiving device, and the initial position information of the sending device, next the first determination unit determines the correction distance value according to the integrated signal strength and the first-path signal strength, and correcting the initial distance value by using the correction distance value to obtain the target distance value, and the correction unit corrects the initial position information according to the target distance value, to obtain the target position information at last. In this solution, the position information of the sending device is corrected through multiple steps in NLOS environment, which may correct the position information and navigation route of the sending device in the NLOS environment, and therefore reducing the influence degree of the positioning of the sending device in the NLOS environment, further improving positioning accuracy of the sending device in the NLOS environment. Meanwhile, the solution can reduce the deviation of the radio communication ranging or positioning position, so that the measurement value in the NLOS environment is closer to the actual value.
Lastly, in the positioning system of the present disclosure, since any one of the above methods is included, the method first obtains the integrated signal strength and the first-path signal strength, then obtains the initial distance value between the sending device and the receiving device, and the initial position information of the sending device, next determines the correction distance value according to the integrated signal strength and the first-path signal strength, and corrects the initial distance value by using the correction distance value, to obtain the target distance value, and finally corrects the initial position information according to the target distance value, to obtain the target position information. In this solution, the position information of the sending device is corrected through multiple steps in NLOS environment, which may correct the position information and navigation route of the sending device in the NLOS environment, and therefore reducing the influence degree of the positioning of the sending device in the NLOS environment, further improving positioning accuracy of the sending device in the NLOS environment. Meanwhile, the solution can reduce the deviation of the radio communication ranging or positioning position, so that the measurement value in the NLOS environment is closer to the actual value.
The foregoing descriptions are merely preferred embodiments of the present disclosure, but are not intended to limit the protection scope of the present disclosure, and for a person skilled in the art, the present disclosure may have various modifications and changes. Any modifications, equivalent replacements, etc. made within the spirit and principles of the present disclosure should be included in the protection scope of the present disclosure.
| Number | Date | Country | Kind |
|---|---|---|---|
| 202210700298.1 | Jun 2022 | CN | national |
The present disclosure is a continuation of International Application No. PCT/CN2022/139718, filed on Dec. 16, 2022, which claims priority to Chinese Patent Application No. 202210700298.1, filed on Jun. 20, 2022. The disclosures of the aforementioned applications are hereby incorporated by reference in their entireties.
| Number | Date | Country | |
|---|---|---|---|
| Parent | PCT/CN2022/139718 | Dec 2022 | WO |
| Child | 18971636 | US |