Multi-antenna switching UWB double-label positioning optimization method

Through the UWB positioning method of multi-antenna switching and dual-label redundancy constraints, the problems of unstable accuracy and high cost of UWB positioning in complex environments are solved, and a higher accuracy and lower cost indoor positioning solution is achieved.

CN118938128APending Publication Date: 2024-11-12NANJING UNIV OF AERONAUTICS & ASTRONAUTICS
View PDF 0 Cites 2 Cited by

Patent Information

Application Number
CN202410910237.7
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-08
Publication Date
2024-11-12

AI Technical Summary

Technical Problem

UWB positioning has problems of unstable ranging accuracy and high cost in complex indoor environments, especially due to multipath effect error and the limitation of single base stations, which leads to low positioning accuracy and difficult to apply on a large scale.

Method used

The UWB dual-label positioning method with multi-antenna switching is adopted to realize antenna switching through power dividers and switching circuits, introduce redundant constraints of dual-labels, and optimize coordinates by using gradient descent to improve positioning accuracy and reliability.

Benefits of technology

It reduces system costs, improves the accuracy and reliability of UWB positioning, overcomes multipath effect error, achieves higher positioning accuracy and lower cost, and promotes the large-scale application of UWB technology.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118938128A_ABST
    Figure CN118938128A_ABST
Patent Text Reader

Abstract

The invention provides a multi-antenna switching UWB double-label positioning optimization method in the technical field of positioning, aiming at the problem of high application cost caused by the fact that at least three base stations are needed to form a positioning unit by UWB and the condition that the distance measurement precision is easily influenced by random errors in a complex environment. According to the method, the antenna switching is realized through the power divider and the switching circuit, so that only the antenna needs to be mounted on each point for placing the UWB, and the cost of the system is greatly reduced; then, initial positioning of the labels is calculated through bidirectional distance measurement and a least square method, coordinate optimization is carried out on the positioning result through redundancy constraint conditions introduced by the double labels and a gradient descent method, the influence of distance measurement errors is reduced, and the positioning precision is improved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention belongs to the field of positioning technology, and in particular relates to a UWB dual-tag positioning optimization method for multi-antenna switching. Background Art

[0002] Unmanned vehicle technology is widely considered to be a technology that will change the way humans travel in the future. People hope that this technology can reduce traffic accidents, improve the efficiency of the transportation system and meet the needs of personalized travel in the future. Currently, the world's major economic powers are vigorously promoting the development of this technology.

[0003] In the engineering application of unmanned vehicles, location information plays a vital role, and reliable positioning technology has become the focus of more and more attention. With the rise of markets such as unmanned driving and intelligent robots, more stringent indicators have been put forward for the cost, stability and reliability of positioning systems, requiring users to provide global, high-precision, economical and applicable real-time solutions.

[0004] At present, indoor positioning mainly uses radio technology to achieve position calculation, among which UWB technology is one of the technologies with higher indoor positioning accuracy, with the advantages of fast transmission rate and strong anti-multipath capability. The single-base station UWB-AOA solution generally calculates the arrival angle based on the phase difference, with small base station requirements and simple deployment. However, due to the problem of angle resolution, its working distance is short and the positioning accuracy is poor. Therefore, at present, UWB positioning generally establishes a mathematical model for positioning through distance parameters, and then realizes positioning by solving the model.

[0005] To improve UWB positioning accuracy, the ranging accuracy of UWB signals is usually improved. However, there are random errors in complex indoor environments that are difficult to eliminate, such as multipath effect errors, which lead to unstable ranging accuracy of UWB signals. In addition, the high price caused by the need for three base stations to form a positioning unit has always been the biggest obstacle to its large-scale application. Summary of the invention

[0006] In order to overcome the above defects, the present invention provides a UWB dual-tag positioning optimization method with multi-antenna switching, which realizes antenna switching through a power divider and a switching circuit, greatly reduces the cost of the system, introduces redundant constraints through dual tags, and finally realizes coordinate optimization through the gradient descent method.

[0007] The present invention is implemented by adopting the following technical solution, a multi-antenna switching UWB dual-tag positioning optimization method, comprising the following steps:

[0008] Step 1: Connect multiple antennas to a UWB module through a power divider, and design a switch circuit based on a single-chip microcomputer to control the on and off of the signal channel in real time.

[0009] Step 2: Obtain the distance information between the tag and the base station through two-way ranging and Kalman filtering, and then solve the initial positioning value through the least squares method.

[0010] Step 3: Obtain redundant constraints of double labels based on geometric relationships.

[0011] Step 4: Optimize the initial coordinate values ​​through constraint conditions to improve the reliability of the positioning results of the two tags. BRIEF DESCRIPTION OF THE DRAWINGS

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

[0013] Figure 1 It is a schematic diagram of an antenna switching system provided by an embodiment of the present invention.

[0014] Figure 2 It is a schematic diagram of bilateral ranging provided by an embodiment of the present invention.

[0015] Figure 3 It is a schematic diagram of dual-label pose solution provided by an embodiment of the present invention.

[0016] Figure 4 It is a schematic diagram of the overall framework of dual-tag positioning optimization provided by an embodiment of the present invention. DETAILED DESCRIPTION

[0017] In order to enable those skilled in the art to better understand the technical solution of the present invention, the present invention is further described in detail below in conjunction with the accompanying drawings and specific embodiments. The embodiments of the present invention will be described in detail below, and examples of the embodiments are shown in the accompanying drawings, wherein the same or similar reference numerals throughout represent the same or similar elements or elements with the same or similar functions. The embodiments described below with reference to the accompanying drawings are exemplary and are only used to explain the present invention, and cannot be interpreted as limiting the present invention. It can be understood by those skilled in the art that, unless specifically stated, the singular forms "one", "one", "said" and "the" used herein may also include plural forms. It should be further understood that the term "including" used in the specification of the present invention refers to the presence of the features, integers, steps, operations, elements and / or components, but does not exclude the presence or addition of one or more other features, integers, steps, operations, elements, components and / or their groups. It should be understood that when we say that an element is "connected" or "coupled" to another element, it can be directly connected or coupled to other elements, or there may also be intermediate elements. In addition, the "connection" or "coupling" used here may include wireless connection or coupling. The term "and / or" used herein includes any unit and all combinations of one or more associated listed items. It will be understood by those skilled in the art that, unless otherwise defined, all terms (including technical terms and scientific terms) used herein have the same meaning as generally understood by those of ordinary skill in the art to which the present invention belongs. It should also be understood that terms such as those defined in general dictionaries should be understood to have meanings consistent with the meanings in the context of the prior art, and will not be interpreted with idealized or overly formal meanings unless defined as herein.

[0018] The present invention will be further described in detail below with reference to the accompanying drawings and through specific embodiments. The following embodiments are only illustrative and not restrictive, and the protection scope of the present invention cannot be limited thereto.

[0019] Step 1:

[0020] The UWB multi-antenna switching positioning system consists of a UWB base station, a UWB tag, a CPU motherboard, a power distributor, several antennas and a switch control circuit (such as Figure 1 ).

[0021] (1) Determine the number of antennas required based on the positioning range, and then select an appropriate power divider to connect the antennas. Since the distance between antennas may be very far when the positioning area is relatively wide, it is inevitable to encounter the problem of excessive signal attenuation caused by long-distance transmission. Therefore, low-loss transmission cables are used and appropriate signal enhancement is performed.

[0022] (2) The control circuit controls the on / off status of several signal channels in the microwave switch in real time, so that only one UWB module can sequentially receive signals transmitted from multiple antennas without interfering with each other.

[0023] Step 2:

[0024] The distance information between the tag and the base station is obtained through two-way ranging and linear Kalman filtering, and then the initial positioning value is solved by the least squares method. Figure 2 )

[0025] (1) Deploy base stations according to the positioning range and write the coordinates into the UWB tag.

[0026] (2) Obtain the ranging value between the base station and the tag through the bilateral ranging method, taking the TWR of a pair of tags and base stations as an example. Assume that the three messages are M1, M2, and M3, Device A measures three timestamps: M1_tx, M2_rx, and M3_tx, and Device B measures three timestamps: M1_rx, M2_tx, and M3_rx. The three timestamps measured by Device A are sent to Device B along with the M3 message, and Device B finally obtains six timestamps. The four time lengths can be calculated by the timestamp difference, namely

[0027]

[0028] The flight time calculation formula of the signal after transformation is:

[0029]

[0030] After calculating the flight time Tprop (TOF), multiply it by the speed of light constant to get the distance value.

[0031] (3) The distance measurement results are filtered through a 1-dimensional Kalman filter to obtain the measured distances from the two tags to each base station.

[0032] (4) The UWB tag positioning problem can be described as: given the distance between a point in three-dimensional space and N points with certain positions, find the position of the point. Assuming that the system has four UWB base stations and they are all on the same horizontal plane, the following set of equations can be listed based on the geometric constraints:

[0033]

[0034] In the formula is the distance measurement value from the UWB tag to each UWB base station, ε k is the distance measurement error, P = [xyz] T is the coordinate value of the UWB tag to be solved, A kis the coordinate value of the kth UWB base station, k = 1, 2, 3, 4.

[0035] Formula (3) is a nonlinear system of equations, which is not easy to solve directly, and due to the existence of distance measurement errors, the system of equations may have no solution. Therefore, the above label positioning problem is transformed from the problem of accurately solving the nonlinear system of equations to the optimal estimation problem of nonlinear optimization.

[0036] Because in the LOS case, ε k It is usually modeled as a zero-mean Gaussian random variable, and in the assumed system, the coefficient matrix is ​​irreversible. Therefore, this paper uses the linear least squares method to obtain the coordinate equation system:

[0037]

[0038] The least squares solution of equation (4) is:

[0039] W=(U T U) -1 U T v (5)

[0040] Where W = [xy] T .

[0041] Step 3: Obtain the redundant constraints of the yaw angle and double labels based on the geometric relationship. Figure 2 )

[0042] (1) Two UWB tags are placed at fixed intervals along the axial direction of the robot, and l represents the distance between the two UWB tags.

[0043] (2) Calculate the initial coordinate values ​​P of the two tags through step 1 x =(x p ,y p ), P y =(x q ,y q ).

[0044] (3)θ represents the robot’s posture angle, and the equation to be solved is as follows:

[0045]

[0046] (4) In order to ensure that the robot's attitude angle is within the range of [-π, π], it is necessary to further constrain the angle calculated by the above formula. The angle is judged according to the robot's orientation Δx in the UWB coordinate system. When Δx is positive, the angle satisfies the above formula between [-π / 2, π / 2]. When Δx < 0 and Δy > 0, θ + π. When Δx < 0 and Δy < 0, θ - π. This ensures the range of the angle.

[0047] Step 4: Optimize the initial coordinate values ​​through constraint conditions to improve the reliability of the positioning results of the two tags.

[0048] The distance l between the two positioning tags and the heading angle φ output by the IMU are used as constraints. The cost function is set according to the distance and heading angle errors calculated by the initial coordinate values. Then, the gradient descent method is used to optimize the initial coordinate values ​​to improve the credibility of the positioning results. Figure 3 As shown, the specific steps mainly include three steps:

[0049] (1) Set the cost function of the gradient descent method:

[0050] J=β((||P x -P y || 2 -l 2 ) 2 +f(P x , P y ,θ) 2 )+(1-β)J - last (7)

[0051] Where: P x and P y They represent the space vectors represented by the coordinates of the two positioning tags respectively; l represents the distance between the two UWB tags, and φ represents the heading angle obtained by the IMU; represents the angle error, (||P x -P y || 2 -l 2 ) 2 represents the distance error. Their function is to constrain the positioning tags using the geometric parameters between them to improve the optimization quality of the positioning tag coordinates. β is the weight coefficient of the momentum method, which is set to 0.9 to reduce iterative oscillation and speed up convergence. J - last represents historical data.

[0052] (2) Calculate J versus P x and P y The first-order partial derivative of

[0053]

[0054] Where: f′(P x , P y , φ) represents the function f(P x , P y ,φ) for P x Find the first-order partial derivative.

[0055] (3) Limit the number of iterations and pass the condition |Jk+1 -J k |<ε=10 -3 (k represents the number of iterations) Determine whether J converges.

[0056] If it does not converge, use Replace the last positioning tag coordinate value and go to step (2), where δ = 10 -3 Indicates the step size of each iteration. If converged, the iteration is stopped to obtain the optimized positioning label coordinates. At the same time, the number of iterations is limited. If it still does not converge within 200 times, the iteration is stopped and the coordinates are output.

Claims

1. A multi-antenna switching UWB dual-tag positioning optimization method is characterized by: Step 1: Connect multiple antennas to a UWB module through a power divider, and design a switch circuit based on a single-chip microcomputer to control the on and off of the signal channel in real time; Step 2: Obtain the distance information between the tag and the base station through two-way ranging and Kalman filtering, and then calculate the initial positioning value through the least squares method; Step 3: Obtain redundant constraints of double labels based on geometric relationships; Step 4: Optimize the initial coordinate values ​​through constraint conditions to improve the reliability of the positioning results of the two tags.

2. The method according to claim 1, characterized in that Connect multiple antennas to a UWB module through a power divider, and design a switch circuit based on a single-chip microcomputer to control the on and off of the signal channel in real time, including: (1) Determine the number of antennas required based on the positioning range, and then select an appropriate power divider to connect the antennas. Since the distance between antennas may be very far when the positioning area is relatively wide, it is inevitable to encounter the problem of excessive signal attenuation caused by long-distance transmission. Therefore, low-loss transmission cables are used and appropriate signal enhancement is performed; (2) The control circuit controls the on / off status of several signal channels in the microwave switch in real time, so that only one UWB module can sequentially receive signals transmitted from multiple antennas without interfering with each other.

3. The method according to 1, characterized in that The step 2 includes: (1) Deploy base stations according to the positioning range and write the coordinates into the UWB tag; (2) Obtain the distance value between the base station and the tag through the bilateral ranging method; (3) The distance measurement results are subjected to 1D Kalman filtering to obtain the measured distances from the two tags to each base station; (4) Calculate the initial positioning value using the least squares method.

4. The method according to 3, characterized in that The distance value between the base station and the tag is obtained through the bilateral ranging method, including: Take the TWR of a pair of tags and base stations as an example. Assume that the three messages are M1, M2, and M3. Device A measures three timestamps: M1_tx, M2_rx, and M3_tx. Device B measures three timestamps: M1_rx, M2_tx, and M3_rx. The three timestamps measured by Device A are sent to Device B along with the M3 message. Device B finally obtains six timestamps. The four time lengths can be calculated by the timestamp difference, namely: The flight time calculation formula of the signal after transformation is: After calculating the flight time Tprop (TOF), multiply it by the speed of light constant to get the distance value.

5. The method according to 3, characterized in that: The initial positioning value is calculated by the least square method, including: The UWB tag positioning problem can be described as: given the distance between a point in three-dimensional space and N points determined by the position, find the position of the point. Assuming that the system has four UWB base stations and they are all on the same horizontal plane, the following set of equations can be listed according to the geometric constraints: In the formula is the distance measurement value from the UWB tag to each UWB base station, ε k is the distance measurement error, P = [xyz] T is the coordinate value of the UWB tag to be solved, A k is the coordinate value of the kth UWB base station, k = 1, 2, 3, 4; Formula (3) is a nonlinear equation system, which is not easy to solve directly. In addition, due to the existence of distance measurement errors, the equation system may have no solution. Therefore, the above label positioning problem is converted from the problem of accurately solving the nonlinear equation system to the optimal estimation problem of nonlinear optimization. Because in the LOS case, ε k It is usually modeled as a zero-mean Gaussian random variable, and in the assumed system, the coefficient matrix is ​​irreversible, so this paper uses the linear least squares method to obtain the coordinate equations: The least squares solution of equation (4) is: W=(U T U) -1 U T v (5) Where W = [xy] T .

6. The method according to item 1, characterized in that: The step three includes: (1) Two UWB tags are placed at fixed intervals along the axial direction of the robot, where l represents the distance between the two UWB tags; (2) Calculate the initial coordinate values ​​P of the two tags through step 1 x =(x p ,y p ), P y =(x q ,y q ); (3)θ represents the robot’s posture angle, and the equation to be solved is as follows: (4) In order to ensure that the solved robot attitude angle is within the range of [-π, π], it is necessary to further constrain the angle calculated by the above formula. The angle is judged according to the orientation Δx of the robot in the UWB coordinate system. When Δx is positive, the required angle satisfies the above formula between [-π / 2, π / 2]. When Δx < 0 and Δy > 0, θ + π. When Δx < 0 and Δy < 0, θ - π, so as to ensure the range of the angle.

7. The method according to item 1, characterized in that: The step 4 includes: (1) The distance l between the two positioning tags and the heading angle φ output by the IMU are used as constraints; (2) Setting the cost function based on the distance and heading angle errors calculated from the initial coordinate values; (3) Use the gradient descent method to optimize the initial coordinate values ​​and improve the credibility of the positioning results.

8. The method according to 6, characterized in that The cost function is set based on the distance and heading angle errors calculated based on the initial coordinate values, including: Where: P x and P v They represent the space vectors represented by the coordinates of the two positioning tags respectively; l represents the distance between the two UWB tags, and φ represents the heading angle obtained by the IMU; represents the angle error, (||P x -P y || 2 -l 2 ) 2 represents the distance error. Their function is to constrain the positioning tags using the geometric parameters between them to improve the optimization quality of the positioning tag coordinates. β is the weight coefficient of the momentum method, which is set to 0.9 to reduce iterative oscillation and speed up convergence. J_last represents historical data.

9. The method according to 6, characterized in that Use the gradient descent method to optimize the initial coordinates, including: (1) Calculate J versus P x and P y The first-order partial derivative of : Where: f′(P x , P y , φ) represents the function f(P x , P y ,φ) for P x Find the first-order partial derivative; (2) Limit the number of iterations and pass the condition |J k+1 -J k |<ε=10 -3 (k represents the number of iterations) Determine whether J converges: If not, use Replace the last positioning tag coordinate value P tag,,i , go to step (2), where δ = 10 -3 Indicates the step size of each iteration; if converged, the iteration is stopped to obtain the optimized positioning label coordinates, and the number of iterations is limited. If it has not converged within 200 times, the iteration is stopped and the coordinates are output.

Citation Information

Cited By

  • Method and device for evaluating positioning credibility of aircraft

    CN121634162A

  • Method and device for evaluating the reliability of the positioning of an aircraft

    CN121634162B