Ultra-wideband localization method, device, and system

Abstract

An ultra-wideband (UWB) localization method, a UWB localization device, and a UWB localization system are provided. The UWB method includes: determining whether or not a plurality of UWB hardware measurement deviations are calibrated; determining, when the UWB hardware measurement deviations are calibrated, whether or not a plurality of anchor coordinates of anchors are automatically measured; obtaining, when the anchor coordinates of the anchors are automatically measured, a plurality of measurement distances between each of the anchors and a tag, respectively, and deducting the UWB hardware measurement deviations from the measurement distances, respectively; and calculating a tag coordinate of the tag according to the measurement distances from which the UWB hardware measurement deviations are deducted.

Claims

1. An ultra-wideband (UWB) localization method, adapted to a UWB localization system, the UWB localization system including a tag and a plurality of anchors, the UWB localization method comprising: determining whether or not a plurality of UWB hardware measurement deviations are calibrated; determining, when the UWB hardware measurement deviations are calibrated, whether or not a plurality of anchor coordinates of the anchors are automatically measured; obtaining, when the anchor coordinates of the anchors are automatically measured, a plurality of measurement distances between each of the anchors and the tag, respectively, and deducting the UWB hardware measurement deviations from the measurement distances, respectively; and calculating a tag coordinate of the tag according to the measurement distances from which the UWB hardware measurement deviations are deducted; wherein the step of calculating the tag coordinate of the tag further includes: calculating a plurality of first factors, which is expressed by the following equation:
d′.sub.i.sup.2=d.sub.i.sup.2−[({tilde over (x)}−x.sub.i).sup.2+({tilde over (y)}−y.sub.i).sup.2], wherein d′.sub.i is the i.sup.th first factor of the plurality of first factors, d.sub.i is a distance between the tag and the i.sup.th anchor of the plurality of anchors, {tilde over (x)} is a X-axis coordinate of the tag, x.sub.i is an X-axis coordinate of the i.sup.th anchor of the plurality of anchors, y.sub.i is a Y-axis coordinate of the i.sup.th anchor of the plurality of anchors, and {tilde over (y)} is a Y-axis coordinate of the tag; defining a plurality of second factors as a plurality of differences between a plurality of Z-axis coordinates of the anchor coordinates and an average height of the anchors, wherein a Z-axis coordinate of the tag coordinate is greater than the average height; and calculating the Z-axis coordinate of the tag coordinate according to the plurality of first factors, the plurality of second factors and a cost function, wherein the cost function is indicated as: $\mathrm{.Math.}\left({\tilde{z}}^{\prime }\right)=\frac{1}{N}\times {.Math.}_{i=1}^N{\left[{\left({\tilde{z}}^{\prime }-z_i^{\prime }\right)}^2-d_i^{\prime 2}\right]}^2,$ wherein {tilde over (z)}′ is the Z-axis coordinate of the tag coordinate, N is a quantity of the anchors, N is an integer greater than 3, z′.sub.i is the i.sup.th second factor of the plurality of second factors, d′.sub.i is the i.sup.th first factor of the plurality of first factors, and i is an integer between 1 and N.

2. The UWB localization method according to claim 1, wherein, when the UWB hardware measurement deviations are not calibrated, the UWB localization method further comprises: obtaining the measurement distances between each of the anchors and the tag, respectively, and a plurality of actual altitudes of the tag; obtaining the UWB hardware measurement deviations through a least squares error approach, according to the measurement distances and the actual altitudes; and recording the UWB hardware measurement deviations.

3. The UWB localization method according to claim 2, wherein the measurement distances are calculated according to a double-sided two-way ranging method, and the actual altitudes are calculated according to an infrared ranging method.

4. The UWB localization method according to claim 1, wherein, when the UWB hardware measurement deviations are not calibrated, the UWB localization method further comprises: obtaining the measurement distances between each of the anchors and the tag, respectively; deducting the UWB hardware measurement deviations from the measurement distances, respectively; and calculating the anchor coordinates according to the measurement distances from which the UWB hardware measurement deviations are deducted.

5. An ultra-wideband (UWB) localization device adapted to a UWB localization system including a tag, a plurality of anchors, and a traffic management cloud server, the UWB localization device being disposed on the tag, the UWB localization device comprising: a distance measurement module for measuring a plurality of measurement distances between each of the anchors and the tag, respectively, and for measuring a plurality of actual altitudes between the tag and a datum plane; a first communication module coupled to the distance measurement module and being used to transmit the measurement distances and the actual altitudes; and a processing module coupled to the first communication module, which is used to calculate a tag coordinate of the tag according to the measurement distances and the actual altitudes and then transmit the tag coordinate to the traffic management cloud server; wherein the processing module calculates a plurality of first factors, which is expressed by the following equation:
d′.sub.i.sup.2=d.sub.i.sup.2−[({tilde over (x)}−x.sub.i).sup.2+({tilde over (y)}−y.sub.i).sup.2], wherein d′.sub.i is the i.sup.th first factor of the plurality of first factors, d.sub.i is a distance between the tag and the i.sup.th anchor of the plurality of anchors, {tilde over (x)} is an X-axis coordinate of the tag, x.sub.i is an X-axis coordinate of the i.sup.th anchor of the plurality of anchors, y.sub.i is a Y-axis coordinate of the i.sup.th anchor of the plurality of anchors, and {tilde over (y)} is a Y-axis coordinate of the tag; wherein the processing module defines a plurality of second factors as a plurality of differences between a plurality of Z-axis coordinates of the anchor coordinates and an average height of the anchors, wherein a Z-axis coordinate of the tag coordinate is greater than the average height; and wherein the processing module calculates the Z-axis coordinate of the tag coordinate according to the plurality of first factors, the plurality of second factors and a cost function, wherein the cost function is indicated as: $\mathrm{.Math.}\left({\tilde{z}}^{\prime }\right)=\frac{1}{N}\times {.Math.}_{i=1}^N{\left[{\left({\tilde{z}}^{\prime }-z_i^{\prime }\right)}^2-d_i^{\prime 2}\right]}^2,$ wherein {tilde over (z)}′ is the Z-axis coordinate of the tag coordinate, N is a quantity of the anchors, N is an integer greater than 3, z′.sub.i is the i.sup.th second factor of the plurality of second factors, d′.sub.i is the i.sup.th first factor of the plurality of first factors, and i is an integer between 1 and N.

6. The UWB localization device according to claim 5, wherein the processing module includes: a processor coupled to the first communication module and being used to calculate a plurality of UWB hardware measurement deviations of the distance measurement module and a plurality of anchor coordinates of the anchors according to the measurement distance and the actual altitudes; a memory coupled to the processor and being used to store a code, the measurement distances, the actual altitudes, the UWB hardware measurement deviations, and the anchor coordinates; and a second communication module coupled to the processor and being used to transmit the tag coordinate to the traffic management cloud server.

7. The UWB localization device according to claim 6, wherein the code is used to instruct the processor to execute a UWB localization method, the UWB localization method includes: determining, through the processor, whether or not the UWB hardware measurement deviations are calibrated; determining, through the processor, when the UWB hardware measurement deviations are calibrated, whether or not the anchor coordinates of the anchors are automatically measured; obtaining, through the distance measurement module, when the anchor coordinates of the anchors are automatically measured, the measurement distances between each of the anchors and the tag, respectively; deducting, through the processor, the UWB hardware measurement deviations from the measurement distances, respectively; and calculating, through the processor, the tag coordinate of the tag according to the measurement distances from which the UWB hardware measurement deviations are deducted.

8. The UWB localization device according to claim 7, wherein, when the UWB hardware measurement deviations are not calibrated, the UWB localization method further includes: obtaining, through the distance measurement module, the measurement distances between each of the anchors and the tag, respectively, and the actual altitudes of the tag; obtaining, through the processor, the UWB hardware measurement deviations through a least squares error approach, according to the measurement distances and the actual altitudes; and recording the UWB hardware measurement deviations through a memory.

9. The UWB localization device according to claim 7, wherein, when the UWB hardware measurement deviations are not calibrated, the UWB localization method further includes: obtaining, through the distance measurement module, the measurement distances between each of the anchors and the tag, respectively; deducting, through the processor, the UWB hardware measurement deviations from the measurement distances, respectively; and calculating, through the processor, the anchor coordinates according to the measurement distances from which the UWB hardware measurement deviations are deducted.

10. The UWB localization device according to claim 5, wherein the measurement distances are calculated according to a double-sided two-way ranging method, and the actual altitudes are calculated according to an infrared ranging method.

11. The UWB localization device according to claim 5, wherein the tag is an unmanned aerial vehicle, an unmanned aircraft, or a drone.

12. An ultra-wideband (UWB) localization system, comprising: a tag; a plurality of anchors; a traffic management cloud server; and a UWB localization device configured on the tag, including: a distance measurement module for measuring a plurality of measurement distances between each of the anchors and the tag, respectively, and for measuring a plurality of actual altitudes between the tag and a datum plane; a first communication module coupled to the distance measurement module and being used to transmit the measurement distances and the actual altitudes; and a processing module coupled to the first communication module and being used to calculate a tag coordinate of the tag according to the measurement distances and the actual altitudes and then transmit the tag coordinate to the traffic management cloud server; wherein the processing module calculates a plurality of first factors, which is expressed by the following equation:
d′.sub.i.sup.2=d.sub.i.sup.2−[({tilde over (x)}−x.sub.i).sup.2+({tilde over (y)}−y.sub.i).sup.2], wherein d′.sub.i is the first factor of the plurality of first factors, d.sub.i is a distance between the tag and the i.sup.th anchor of the plurality of anchors, {tilde over (x)} is an X-axis coordinate of the tag, x.sub.i is an X-axis coordinate of the i.sup.th anchor of the plurality of anchors, y.sub.i is a Y-axis coordinate of the i.sup.th anchor of the plurality of anchors, and {tilde over (y)} is a Y-axis coordinate of the tag; wherein the processing module defines a plurality of second factors as a plurality of differences between a plurality of Z-axis coordinates of the anchor coordinates and an average height of the anchors, wherein a Z-axis coordinate of the tag coordinate is greater than the average height; and wherein the processing module calculates the Z-axis coordinate of the tag coordinate according to the plurality of first factors, the plurality of second factors and a cost function, wherein the cost function is indicated as: $\mathrm{.Math.}\left({\tilde{z}}^{\prime }\right)=\frac{1}{N}\times {.Math.}_{i=1}^N{\left[{\left({\tilde{z}}^{\prime }-z_i^{\prime }\right)}^2-d_i^{\prime 2}\right]}^2,$ wherein {tilde over (z)}′ is the Z-axis coordinate of the tag coordinate, N is a quantity of the anchors, N is an integer greater than 3, z′.sub.i is the i.sup.th second factor of the plurality of second factors, d′.sub.i is the i.sup.th first factor of the plurality of first factors, and i is an integer between 1 and N.

13. The UWB localization system according to claim 12, wherein the measurement distances are calculated according to a double-sided two-way ranging method, and the actual altitudes are calculated according to an infrared ranging method.

14. The UWB localization system according to claim 12, wherein the processing module includes: a processor coupled to the first communication module and being used to calculate a plurality of UWB hardware measurement deviations of the distance measurement module and a plurality of anchor coordinates of the anchors according to the measurement distance and the actual altitudes; a memory coupled to the processor and being used to store a code, the measurement distances, the actual altitudes, the UWB hardware measurement deviations, and the anchor coordinates; and a second communication module coupled to the processor and being used to transmit the tag coordinate to the traffic management cloud server.

15. The UWB localization system according to claim 14, wherein the code is used to instruct the processor to execute a UWB localization method, the UWB localization method includes: determining, through the processor, whether or not the UWB hardware measurement deviations are calibrated; determining, through the processor, when the UWB hardware measurement deviations are calibrated, whether or not the anchor coordinates of the anchors are automatically measured; obtaining, through the distance measurement module, when the anchor coordinates of the anchors are automatically measured, the measurement distances between each of the anchors and the tag, respectively; deducting, through the processor, the UWB hardware measurement deviations from the measurement distances, respectively; and calculating, through the processor, the tag coordinate of the tag according to the measurement distances from which the UWB hardware measurement deviations are deducted.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

(1) The described embodiments may be better understood by reference to the following description and the accompanying drawings, in which:

(2) FIG. 1 is a schematic view of an unmanned aerial vehicle (UAV) traffic management system;

(3) FIG. 2 is a schematic view of an ultra-wideband localization model according to an embodiment of the present disclosure;

(4) FIG. 3 is a functional block diagram of a localization device according to one embodiment of the present disclosure;

(5) FIG. 4 is a flowchart showing a localization method adapted to the localization device shown in FIG. 3 according to one embodiment of the present disclosure;

(6) FIG. 5 to FIG. 7 are respectively a planar localization route map, an altitude localization route map, and a localization deviation cumulative distribution function diagram of a simulation of an UAV flying at a target altitude of three meters according to one embodiment of the present disclosure;

(7) FIG. 8 to FIG. 10 are respectively a planar localization route map, an altitude localization route map, and a localization deviation cumulative distribution function diagram of a simulation of a UAV flying at a target altitude of five meters according to one embodiment of the present disclosure; and

(8) FIG. 11 to FIG. 13 are respectively a planar localization route map, an altitude localization route map, and a localization deviation cumulative distribution function diagram of a simulation of a UAV flying at a target altitude of three meters and five meters according to one embodiment of the present disclosure.

DETAILED DESCRIPTION OF THE EXEMPLARY EMBODIMENTS

(9) The present disclosure is more particularly described in the following examples that are intended as illustrative only since numerous modifications and variations therein will be apparent to those skilled in the art. Like numbers in the drawings indicate like components throughout the views. As used in the description herein and throughout the claims that follow, unless the context clearly dictates otherwise, the meaning of “a”, “an”, and “the” includes plural reference, and the meaning of “in” includes “in” and “on”. Titles or subtitles can be used herein for the convenience of a reader, which shall have no influence on the scope of the present disclosure.

(10) The terms used herein generally have their ordinary meanings in the art. In the case of conflict, the present document, including any definitions given herein, will prevail. The same thing can be expressed in more than one way. Alternative language and synonyms can be used for any term(s) discussed herein, and no special significance is to be placed upon whether a term is elaborated or discussed herein. A recital of one or more synonyms does not exclude the use of other synonyms. The use of examples anywhere in this specification including examples of any terms is illustrative only, and in no way limits the scope and meaning of the present disclosure or of any exemplified term. Likewise, the present disclosure is not limited to various embodiments given herein. Numbering terms such as “first”, “second” or “third” can be used to describe various components, signals or the like, which are for distinguishing one component/signal from another one only, and are not intended to, nor should be construed to impose any substantive limitations on the components, signals or the like.

EMBODIMENT

(11) Referring to FIG. 2, FIG. 2 is a schematic view of an ultra-wideband (UWB) localization model 2 according to an embodiment of the present disclosure. The UWB localization model 2 can be used to simulate a UWB localization system, including a tag T (i.e., an unmanned aerial vehicle (UAV), an unmanned aircraft (UAS), or a drone) and a plurality of anchors A.sub.1 to A.sub.N, where N is an integer greater than three. A plurality of distances between the tag T and the anchors A.sub.1 to A.sub.N are respectively d.sub.1 to d.sub.N, and the measurement distances d.sub.1 to d.sub.N are calculated through a double-sided two-way ranging method using the UWB wireless communication technology. In other words, the tag T and each of the anchors A.sub.1 to A.sub.N send UWB packets to each other and record transmission timestamps and receiving timestamps, respectively, and a distance measurement module of the tag T (e.g., the distance measurement module 31 shown in FIG. 3) calculates a plurality of times of flight (ToF) of the UWB packets accordingly, and then multiply the ToFs by the speed of light to infer corresponding distances (the measurement distances d.sub.1 to d.sub.N) between the tag T and each of the anchors A.sub.1 to A.sub.N.

(12) In a three-dimensional model composed of X, Y, and Z axes, assuming that a coordinate of the tag T is {right arrow over (T)}({tilde over (x)},{tilde over (y)},{tilde over (z)}), and coordinates of the anchors A.sub.1 to A.sub.N are known to be A.sub.1(x.sub.1, y.sub.1, z.sub.1) to A.sub.N(x.sub.N, y.sub.N, z.sub.N), a distance d.sub.i between the tag T and an i.sup.th anchor A.sub.i can be expressed by the following equation (1):
({tilde over (x)}−x.sub.i).sup.2+({tilde over (y)}−y.sub.i).sup.2+({tilde over (z)}−z.sub.i).sup.2=d.sub.i.sup.2  (1);
in which i is an integer, and 1≤i≤N.

(13) Taking the anchor A.sub.N as a reference point, the distance d.sub.N between the tag T and the anchor A.sub.N can be expressed by the following equation (2):
({tilde over (x)}−x.sub.N).sup.2+({tilde over (y)}−y.sub.N).sup.2+({tilde over (z)}−z.sub.N).sup.2=d.sub.N.sup.2  (2);
when {tilde over (x)}−x.sub.i={tilde over (x)}−x.sub.N−(x.sub.1−x.sub.N),{tilde over (y)}−y.sub.i={tilde over (y)}−y.sub.N(y.sub.i−y.sub.N), {tilde over (z)}−z.sub.i={tilde over (z)}−z.sub.N−(z.sub.i−z.sub.N), equation (1) can be rewritten as the following equation (3):
(({tilde over (x)}−x.sub.N)−(x.sub.i−x.sub.N)).sup.2+({tilde over (y)}−y.sub.N)−(y.sub.i−y.sub.N)).sup.2+(({tilde over (z)}−z.sub.N)−(z.sub.i−z.sub.N)).sup.2=d.sub.i.sup.2  (3);
by subtracting equation (1) from equation (3) and then organizing, the following equation (4) is obtained:
(x.sub.i−x.sub.N)({tilde over (x)}−x.sub.N)+(y.sub.i−y.sub.N)({tilde over (y)}−y.sub.N)+(z.sub.i−z.sub.N)({tilde over (z)}−z.sub.N)=½(R.sub.iN.sup.2−d.sub.i.sup.2+d.sub.N.sup.2)  (4);

(14) in which, R.sub.iN.sup.2=(x.sub.i−x.sub.N).sup.2+(y.sub.i−y.sub.N).sup.2+(z.sub.1−z.sub.N).sup.2.

(15) Finally, the equation (4) is rewritten into a matrix form as the following equation (5), and the coordinate {right arrow over (T)}({tilde over (x)}, {tilde over (y)}, {tilde over (z)}) of the tag T can be obtained through a least squares error (LSQ) method.

(16) However, when a height of the tag T (i.e., the Z-axis coordinate {tilde over (z)}) is multiple times the height of the anchors A.sub.1 to A.sub.N (i.e., the Z-axis coordinates Z.sub.1 to Z.sub.N), under a premise that the LSQ method is used to solve the equations, Z-axis spans between the anchors A.sub.1 to A.sub.N are very small relative to the Z-axis coordinate {tilde over (z)} of the tag T, thereby causing altitude deviations on the scale of meters. In practice, under the premise that the LSQ method is used to solve the equations, in order to reduce the altitude deviations of the UAV (i.e., the tag T) that is tens of meters above the ground to be on the scale of centimeters, altitude differences among the anchors A.sub.1 to A.sub.N are required to be increased, which is unpractical. On the other hand, since X-axis spans and Y-axis spans between the anchors A.sub.1 to A.sub.N are large enough relative to an X-axis coordinate and a Y-axis coordinate of the tag T, the deviations solved by the LSQ method in the horizontal plane (i.e., the XY plane) are on the scale of centimeters. Accordingly, the X-axis coordinate {tilde over (x)} and the Y-axis coordinate {tilde over (y)} obtained from equations (1) to equation (5) can be substituted as constants, equation (1) is then rewritten, and the rewritten equation (1) is substituted into a cost function, indicated as equation (6), so as to calculate the Z-axis coordinate 2 of the tag T. In other words, the cost function of the present disclosure improves a conventional method of solving three unknowns to a method of solving only one unknown, through subtracting the X-axis coordinate component {tilde over (x)} and the Y-axis coordinate component {tilde over (y)} from the distance d.sub.i measured by the UWB ranging method, and then calculating the Z-axis coordinate {tilde over (z)} according to the cost function.

(17) In a scenario of a UAV operation test (e.g., a performance test), the anchors A.sub.1 to A.sub.N are arranged on the ground or close to the ground, and the UAV can then fly above the anchors A.sub.1 to A.sub.N. Accordingly, according to the scenario in practice, it is assumed in the present disclosure that the height of the tag T (i.e., the Z-axis coordinate {tilde over (z)}) is greater than an average height z of the anchors A.sub.1 to A.sub.N, and with the average height being z=1/NΣ.sub.i=1.sup.Nz.sub.i, a parameter is defined as z′.sub.i=z.sub.i−z (i.e., under a premise that the Z-axis coordinates Z.sub.1 to Z.sub.N of the anchors A.sub.1 to A.sub.N are known, the parameter z′.sub.i is defined as a difference between the Z-axis coordinate Z.sub.i of the i.sup.th anchor A.sub.i and the average height z), such that the cost function of the present disclosure can be expressed as equation (6) in the following:
ε({tilde over (z)}′)=1/N×Σ.sub.=1.sup.N[({tilde over (z)}′−z′.sub.i).sup.2−d′.sub.i.sup.2].sup.2  (6);
in which, d′.sub.i.sup.2=d.sub.1.sup.2−[({tilde over (x)}−x.sub.i).sup.2+({tilde over (y)}−y.sub.i).sup.2].

(18) According to equation (6), the parameter d′.sub.i is a value obtained by subtracting the X-axis coordinate component {tilde over (x)} and the Y-axis coordinate component {tilde over (y)} from the distance d.sub.i measured by the UWB ranging method. Since the parameters z′.sub.i and d′.sub.i are known, only a single variable {tilde over (z)}′ in equation (6) needs to be solved.

(19) In order to minimize the altitude deviations, the best solution of the variable {tilde over (z)}′ in equation (6) satisfies a condition of dε/(d{tilde over (z)}′)=0, such that equation (6) can be differentiated to obtain equation (7) as follows:
f({tilde over (z)}′)={tilde over (z)}′.sup.3−A{tilde over (z)}′+B=0  (7);

(20) in which, A=1/N×Σ.sub.i=1.sup.N d′.sub.i.sup.2−3/N×Σ.sub.i=1.sup.Nz′.sub.i.sup.2, B=1/N×Σ.sub.i=1.sup.N d′.sub.i.sup.2z′.sub.i−1/N×Σ.sub.i=1.sup.Nz′.sub.i.sup.3.

(21) Next, Newton's approximation method as shown in equation (8) is used to obtain the solution of the variable {tilde over (z)}′ of equation (7), and iterated to ({tilde over (z)}′.sub.n+1−{tilde over (z)}′.sub.n)<0.01 (unit: meter), in which the variable {tilde over (z)}′.sub.n+1 is a solution of equation (7), and then the average height Z of the anchors A.sub.1 to A.sub.N is added to the variable {tilde over (z)}′.sub.n+1, so as to obtain the height of the tag T. Equation (8) is expressed as follows:
{tilde over (z)}′.sub.n+1={tilde over (z)}′.sub.n−(f({tilde over (z)}′.sub.n))/(f{circumflex over ( )}′({tilde over (z)}′.sub.n))  (8).

(22) FIG. 3 is a functional block diagram of a localization device 30 according to one embodiment of the present disclosure. The localization device 30 can be configured on the tag T (i.e., a UAV, a UAS, or a drone) shown in FIG. 2 to implement the UWB localization model 2 shown in FIG. 2, and can be applied to the UAV traffic management (UTM) system shown in FIG. 1. The localization device 30 includes a distance measurement module 31, a first communication module 32, a processing module 33 and a global positioning system (GPS) module 34.

(23) The distance measurement module 31 is coupled to the first communication module 32, and is used to measure the measurement distances d.sub.1 to d.sub.N between the localization device 30 (i.e., the UAV) and the anchors A.sub.1 to A.sub.N through the UWB wireless communication technology. The GPS module 34 is coupled to the first communication module 32 for generating GPS information Info.sub.GPS.

(24) The first communication module 32 is coupled to the distance measurement module 31, the GPS module 34, and the processing module 33, and the first communication module 32 is used to transmit the measurement distances d.sub.1 to d.sub.N measured by the distance measurement module 31, a plurality of actual altitudes D.sub.1 to D.sub.N of the localization device 30, and the GPS information Info.sub.GPS generated by the GPS module 34 to the processing module 33. In one embodiment, the localization device 30 further includes a height measurement module (not shown in FIG. 3) for measuring the actual altitudes D.sub.1 to D.sub.N between the localization device 30 and a datum plane according to an infrared ranging method. In one embodiment, the height measurement module can be integrated in the distance measurement module 31. In one embodiment, the height measurement module may be a peripheral device that is externally connected to the localization device 30.

(25) The processing module 33 is coupled to the first communication module 32, and is used to calculate the coordinate {right arrow over (T)}({tilde over (x)},{tilde over (y)},{tilde over (z)}) of the tag T according to the measurement distances d.sub.1 to d.sub.N and the actual altitudes D.sub.1 to D.sub.N, and then transmit the coordinate {right arrow over (T)}({tilde over (x)},{tilde over (y)},{tilde over (z)}) to at least one of a traffic management cloud server, i.e., a UAV traffic management (UTM) cloud server 10, and a remote control device 11. In one embodiment, the processing module 33 is used to execute or terminate a localization operation according to a control signal CTRL generated by the remote control device 11.

(26) The processing module 33 includes a processor 330, a memory 331, and a second communication module 332. The processor 330 is coupled to the first communication module 32, the memory 331, and the second communication module 332, and the processor 330 is used to calculate a plurality of UWB hardware measurement deviations E.sub.1 to E.sub.N of the distance measurement module 31 and a plurality of anchor coordinates A.sub.1(x.sub.1, y.sub.1, z.sub.1) to A.sub.N(x.sub.N, y.sub.N, z.sub.N) of the anchors A.sub.1 to A.sub.N according to the measurement distances d.sub.1 to d.sub.N and the actual altitudes D.sub.1 to D.sub.N. Next, the processing module 33 can apply the measurement distances d.sub.1 to d.sub.N and the anchor coordinates A.sub.1(x.sub.1, y.sub.i, z.sub.1) to A.sub.N(x.sub.N, y.sub.N, z.sub.N) to the UWB localization model 2 shown in FIG. 2, so as to calculate the coordinate {right arrow over (T)}({tilde over (x)},{tilde over (y)},{tilde over (z)}) of the tag T accordingly.

(27) The memory 331 is coupled to the processing module 33 for storing a code 333, the measurement distances d.sub.1 to d.sub.N, the actual altitudes D.sub.1 to D.sub.N, the UWB hardware measurement deviations E.sub.1 to E.sub.N, the anchor coordinates A.sub.1(x.sub.1, y.sub.1, z.sub.1) to A.sub.N(x.sub.N, y.sub.N, z.sub.N), and any information related to the localization device 30.

(28) The second communication module 332 is coupled to the processor 330, the UTM cloud server 10, and the remote control device 11, and is used to transmit the coordinate {right arrow over (T)}({tilde over (x)},{tilde over (y)},{tilde over (z)}) to at least one of the UTM cloud server 10 and the remote control device 11 and receives the control signal CTRL generated by the remote control device 11.

(29) Therefore, under the circuit structure shown in FIG. 3, the localization device 30 of the present disclosure can implement the UWB localization model 2 shown in FIG. 2, and the localization device 30 can be applied to the UTM system shown in FIG. 1. In the scenario of the UAV operation test, under a premise that the GPS module 34 is turned off, the localization device 30 of the present disclosure can be configured on the UAV and used to transmit the coordinate {right arrow over (T)}({tilde over (x)},{tilde over (y)},{tilde over (z)}) of the tag T to the UTM cloud server 10 or a related UAV operation test system to provide objective localization information or data to support an effectiveness of the UAV operation test. For example, the UWB localization model 2 of the present disclosure can simulate a UWB localization system to provide the objective localization information or data to support the effectiveness of a UAV operation test or a UAV operation competition, and can be the equivalent of an electronic referee.

(30) FIG. 4 is a flowchart showing a localization method adapted to the localization device 30 shown in FIG. 3 according to one embodiment of the present disclosure. The method shown in FIG. 4 can be compiled into the code 333 and stored in the memory 331 of the localization device 30. The code 333 is used to instruct the processor 330 of the localization device 30 to perform the following steps.

(31) Step 400: Begin.

(32) Step 401: Determining whether or not a plurality of UWB hardware measurement deviations are calibrated. If not, proceed to step 402; if yes, proceed to step 405.

(33) Step 402: Obtaining the measurement distances and the actual altitudes between the tag and each of the anchors.

(34) Step 403: Obtaining the UWB hardware measurement deviations through the LSQ method.

(35) Step 404: Recording the UWB hardware measurement deviations; then returning to step 401.

(36) Step 405: Determining whether or not the anchor coordinates are automatically measured. If not, proceed to step 406; if yes, proceed to step 408.

(37) Step 406: Obtaining the measurement distances between the tag and each of the anchors and deducting the UWB hardware measurement deviations from the measurement distances.

(38) Step 407: Calculating the anchor coordinates; then returning to step 405.

(39) Step 408: Obtaining the distances between each of the anchors and the tag, and subtracting the deviations from the distances.

(40) Step 409: Calculating the tag coordinate.

(41) Step 410: Transmitting the tag coordinates in real time.

(42) Step 411: Determining whether or not to calculate the tag coordinate. If yes; proceed to step 408; if not, proceed to step 412.

(43) Step 412: End.

(44) In step 401 to step 404, the localization device 30 (or the tag T in FIG. 2) determines whether or not the UWB hardware measurement deviations are calibrated; when the UWB hardware measurement deviations are not calibrated, the localization device 30 obtains the respective measurement distances d.sub.1 to d.sub.N between each of the anchors A.sub.1 to A.sub.N and the tag T, and the actual altitudes D.sub.1 to D.sub.N of the tag T through the distance measurement module 31. The UWB hardware measurement deviations E.sub.1 to E.sub.N are then obtained using the LSQ method through the processor 330; and then the UWB hardware measurement deviations E.sub.i to E.sub.N, the measurement distances d.sub.1 to d.sub.N, and the actual altitudes D.sub.1 to D.sub.N are recorded through the memory 331.

(45) When the UWB hardware measurement deviations are calibrated, in step 405 to step 407, the localization device 30 determines whether or not the anchor coordinates A.sub.1(x.sub.1, y.sub.1, z.sub.1) to A.sub.N(x.sub.N, y.sub.N, z.sub.N) have been automatically measured.

(46) When the anchor coordinates A.sub.1 (x.sub.1, y.sub.1, z.sub.1) to A.sub.N(x.sub.N, y.sub.N, z.sub.N) are not automatically measured, the localization device 30 obtains the measurement distances d.sub.1 to d.sub.N from the memory 331 through the processor 330 and the UWB hardware measurement deviations E.sub.1 to E.sub.N, the UWB hardware measurement deviations E.sub.1 to E.sub.N are respectively subtracted from the measurement distances d.sub.1 to d.sub.N, and then the anchor coordinates A.sub.1(x.sub.1, y.sub.1, z.sub.1) to A.sub.N(x.sub.N, y.sub.N, z.sub.N) are calculated through the processor 330.

(47) When the anchor coordinates A.sub.1(x.sub.1, y.sub.i, z.sub.i) to A.sub.N(x.sub.N, y.sub.N, z.sub.N) have been automatically measured, in step 408 to step 410, the localization device 30 obtains the measurement distances d.sub.1 to d.sub.N from the memory 331 through the processor 330 and the UWB hardware measurement deviations E.sub.1 to E.sub.N, the UWB hardware measurement deviations E.sub.1 to E.sub.N are respectively subtracted from the measurement distances d.sub.1 to d.sub.N; the coordinate {right arrow over (T)}({tilde over (x)},{tilde over (y)},{tilde over (z)}) of the tag T is calculated through the processor 330, and then the coordinate {right arrow over (T)}({tilde over (x)},{tilde over (y)},{tilde over (z)}) of the tag T is transmitted (to the UTM cloud server 10) in real time. In step 409, the processor 330 calculates the coordinate {right arrow over (T)}({tilde over (x)},{tilde over (y)},{tilde over (z)}) of the tag T according to the cost function represented by equation (6), equation (7), and equation (8).

(48) Finally, in step 411, the localization device 30 determines whether or not the coordinate {right arrow over (T)}({tilde over (x)},{tilde over (y)},{tilde over (z)}) of the tag T is required to be calculated. In one embodiment, the localization device 30 receives the control signal CTRL through the second communication module 332, and determines whether or not the coordinate {right arrow over (T)}({tilde over (x)},{tilde over (y)},{tilde over (z)}) of the tag T is required to be calculated according to the control signal CTRL. When the coordinate {right arrow over (T)}({tilde over (x)},{tilde over (y)},{tilde over (z)}) of the tag T is required to be calculated, the localization device 30 executes step 408 to step 410 again so as to execute the localization operation. On the other hand, when the coordinate {right arrow over (T)}({tilde over (x)},{tilde over (y)},{tilde over (z)}) of the tag T is not required to be calculated, the localization device 30 terminates the localization operation.

(49) Therefore, through executing the process shown in FIG. 4, the localization device 30 of the present disclosure can implement the UWB localization model 2 shown in FIG. 2, and can be applied to the UTM system shown in FIG. 1.

(50) FIG. 5 to FIG. 7 are respectively a planar localization route map, an altitude localization route map, and a localization deviation cumulative distribution function diagram of a simulation of an UAV flying at a target altitude of three meters and a simulation of a UWB measurement distance standard deviation of 10 centimeters according to one embodiment of the present disclosure. As shown in FIG. 5, a datum plane line is represented by a thick solid line, a planar localization route is represented by a thin solid line, and coordinates of the anchors A.sub.1 to A.sub.4 are (0, 0, 2), (0, 5.6, 2), (13, 5.6, 2.5), and (13, 0, 2), respectively. The X-axis coordinates and the Y-axis coordinates of the tag T of the planar localization route shown in FIG. 5 are obtained through using the LSQ method.

(51) In FIG. 6 and FIG. 7, an altitude localization route of the Z-axis coordinate of the tag T and the localization deviation accumulation curve obtained through the LSQ method are represented by a thick solid line, and an altitude localization route and the localization deviation accumulation curve of the Z-axis coordinate of the tag T obtained through the cost function method of the present disclosure (i.e., the cost function represented by equation (6) and the method shown in FIG. 4) are represented by a thin solid line. A comparison result between the simulations illustrated in FIG. 6 and FIG. 7 respectively is shown in Table 1 below.

(52) TABLE-US-00001 TABLE 1 LSQ method Cost function method Z-axis coordinate range −4 m to 10 m 1 m to 4 m 95% localization deviation 6.59 m 0.84 m accumulation value

(53) According to Table 1, a Z-axis coordinate range obtained by the localization method of the present disclosure is closer to the target altitude of three meters, and the 95% localization deviation accumulation value is less than 1 meter. Therefore, compared with the conventional LSQ method, the localization method of the present disclosure can effectively improve the localization accuracy of the Z-axis coordinate.

(54) FIG. 8 to FIG. 10 are respectively a planar localization route map, an altitude localization route map, and a localization deviation accumulative distribution function diagram of a simulation of a UAV flying at a target altitude of five meters and a simulation of a UWB measurement distance standard deviation of 10 centimeters according to one embodiment of the present disclosure. In FIG. 8, the datum plane line is represented by a thick broken line, and the planar localization route is represented by a thin solid line, and the coordinates of the anchors A.sub.1 to A.sub.4 are (0, 0, 2), (0, 5.6, 2), (13, 5.6, 2.5), and (13, 0, 2), respectively. The X-axis coordinates and the Y-axis coordinates of the tag T of the planar localization route shown in FIG. 8 are obtained through using the LSQ method.

(55) In FIG. 9 and FIG. 10, the altitude localization route of the Z-axis coordinate of the tag T and the localization deviation accumulation curve obtained through the LSQ method are represented by a thick solid line, and the altitude localization route and the localization deviation accumulation curve of the Z-axis coordinate of the tag T obtained through the cost function method of the present disclosure are represented by a thin solid line. A comparison result between the simulations illustrated in FIG. 9 and FIG. 10 respectively is shown in Table 2 below.

(56) TABLE-US-00002 TABLE 2 LSQ method Cost function method Z-axis coordinate range −3 m to 13 m 4.5 m to 5.5 m 95% localization deviation 6.7 m 0.25 m accumulation value

(57) According to Table 2, the Z-axis coordinate range obtained by the localization method of the present disclosure is closer to the target altitude of five meters, and the 95% localization deviation accumulation value is less than 1 meter. Therefore, compared with the conventional LSQ method, the localization method of the present disclosure can effectively improve the localization accuracy of the Z-axis coordinate.

(58) FIG. 11 to FIG. 13 are respectively a planar localization route map, an altitude localization route map, and a localization deviation accumulative distribution function diagram of a simulation of an UAV flying at a target altitude of three meters and five meters according to one embodiment of the present disclosure. In FIG. 11, the datum plane line is represented by a thick broken line, a three-meter planar localization route is represented by a thick solid line, a five-meter planar localization route is represented by a thin solid line, and the coordinates of the anchors A.sub.1 to A.sub.4 are respectively (0, 0, 2), (−0.11, 5.84, 2), (12.93, 5.43, 4.47), and (13.24, 0, 2). The X-axis coordinates and the Y-axis coordinates of the tag T of the planar localization route shown in FIG. 11 are obtained through using the LSQ method.

(59) In FIG. 12 and FIG. 13, the cost function method of the present disclosure is used to obtain a 3-meter altitude localization route and a 3-meter localization deviation accumulation curve of the Z-axis coordinate of the tag T that are each represented by a thick solid line, and a 5-meter altitude localization route and a 5-meter localization deviation accumulation curve that are each represented by a thick solid line. A comparison result between the simulations illustrated respectively in FIG. 12 and FIG. 13 is shown in Table 3 below.

(60) TABLE-US-00003 TABLE 3 Target altitude: 3 m Target altitude: 5 m Z-axis coordinate range 1 m to 4 m 5 m to 6 m 95% localization deviation 1.01 m 0.45 m accumulation value

(61) According to Table 3, in the localization method of the present disclosure, the higher the target altitude is, the lower the 95% localization deviation accumulation value is (i.e., the 95% localization deviation accumulation value of the target altitude of five meters is less than that of the target altitude of three meters). In other words, in the localization method of the present disclosure, the greater a distance between a flying altitude and an anchor, the higher the localization accuracy of the Z-axis coordinate.

BENEFICIAL EFFECTS OF THE EMBODIMENT

(62) One of the beneficial effects of the UWB localization method, device, and system of the present disclosure is that the UWB localization method, device, and system can increase localization accuracy of the Z-axis coordinate through technical solutions of “measuring the measurement distances between the tag and the anchors, respectively through the UWB wireless communication technology” and “calculating a third coordinate component of the tag coordinate according to the cost function”.

(63) The foregoing description of the exemplary embodiments of the disclosure has been presented only for the purposes of illustration and description and is not intended to be exhaustive or to limit the disclosure to the precise forms disclosed. Many modifications and variations are possible in light of the above teaching.

(64) The embodiments were chosen and described in order to explain the principles of the disclosure and their practical application so as to enable others skilled in the art to utilize the disclosure and various embodiments and with various modifications as are suited to the particular use contemplated. Alternative embodiments will become apparent to those skilled in the art to which the present disclosure pertains without departing from its spirit and scope.