3-D Distributed Localization with Mixed Local Relative Measurements
Abstract
This paper studies 3-D distributed network localization using mixed types of local relative measurements. Each node holds a local coordinate frame without a common orientation and can only measure one type of information (relative position, distance, relative bearing, angle, or ratio-of-distance measurements) about its neighboring nodes in its local coordinate frame. A novel rigidity-theory-based distributed localization is developed to overcome the challenge due to the absence of a global coordinate frame. The main idea is to construct displacement constraints for the positions of the nodes by using mixed local relative measurements. Then, a linear distributed localization algorithm is proposed for each free node to estimate its position by solving the displacement constraints. The algebraic condition and graph condition are obtained to guarantee the global convergence of the proposed distributed localization algorithm.
Index Terms:
Distributed localization, sensor network, mixed measurements, network localizability, 3-D spaceI Introduction
Network localization is a fundamental problem in multiagent-related applications such as formation control, cooperative pursuit, target tracking, etc [1, 2, 3, 4]. There are typically two kinds of nodes in a network: anchor nodes and free nodes. The research on network localization focuses on how to localize the unknown free nodes by the known anchor nodes and relative measurements.
In large-scale networks, it may not be practical to equip each sensor with a GPS due to cost and in some environments GPS is not available [5]. In addition, there is usually no central unit that can obtain all the measurements in the network and compute all the positions of the free nodes in a centralized way. Hence, it is more practical to design a distributed localization algorithm such that each free node can estimate its own position by only communicating with its neighboring nodes. The existing distributed algorithms can be divided into four classes: distance-based [6, 7], relative-position-based [8], angle-based [9], and bearing-based [10, 11, 12].
The distance-based network localization has been studied extensively so far. A distance-based network is localizable if and only if it is globally rigid. Based on a generalized barycentric coordinate representation, distance-based distributed protocols are proposed to achieve network localization in both two-dimensional and three-dimensional spaces [6, 7]. Similar result can also be found in the relative-position-based network localization [8]. When each node can measure angles, a semi-definite strategy is used to localize the free nodes iteratively [9]. In the bearing-based network localization, Zhao has proved that an infinitesimally bearing rigid network is localizable [10]. In addition, the problem of how to make use of ratio-of-distance measurements to localize the free nodes is still not solved.
Note that the aforementioned works assume that the measurements of all the nodes are of identical type. In a large-scale network, different node may be equipped with different sensor and has different sensing capability. It is more practical to consider the network localization with mixed measurements. Some nodes may measure only relative distances, while others may measure only relative bearing, angle, relative position, or ratio-of-distance. The existing works consider distributed localization with mixed distance and bearing measurements [13, 14, 15], but [13] is limited to 2-D space and [14, 15] need a global coordinate frame. Another work [16] develops a distributed algorithm for 2-D network localization with mixed distance, bearing, and relative position measurements. Note that the 3-D case cannot be solved by trivially extending the results in [13, 16].
Different from the works [13, 14, 16, 15], we consider 3-D network localization with mixed local relative measurements without any known global coordinate frame. Inspired by our recent work that studies 3-D network localization with the same type of local relative measurements [17], in this paper, we study the network localization with mixed types of measurements, which is more challenging. Each node can only have one of the five types of measurements (relative position, distance, relative bearing, angle, and ratio-of-distance measurements) about its neighboring nodes in its local coordinate frame. A novel rigidity-theory-based distributed localization is developed to overcome the challenge due to the absence of a global coordinate frame. The key idea is to construct displacement constraints for the positions of the nodes by using mixed local relative measurements. Then, a linear distributed localization algorithm is proposed for each free node to estimate its own position by solving the displacement constraints. Moreover, algebraic condition and graph condition are obtained to ensure global convergence of the distributed localization algorithm.
The remaining parts of the paper are structured as follows: angle-displacement rigidity theory and problem statement are given in Section II and Section III, respectively. The localization problem with mixed local relative measurements is formulated in Section IV, where the corresponding algebraic and graph conditions for localizability are given. In addition, a distributed localization algorithm is proposed to ensure global convergence of the distributed localization algorithm. Some numerical examples are given in Section V to illustrate the theoretical results. Section VI ends this paper with some conclusions.
II Preliminaries of Angle-displacement Rigidity Theory
II-A Notations
Let , , , , , and denote the norm, null space, dimension, span, cardinality rank of a given vector or matrix, respectively. The Kronecker product and the determinant of a square matrix are denoted by and , respectively. is the identity matrix, and . An undirected graph consists of a vertex set of elements called nodes and an edge set of ordered pairs of nodes called edges, where . The set of neighbors of node is denoted as . Suppose is a global coordinate frame in . Let be the positions of nodes in , and is the relative position in .
Next, we introduce the concepts of angle constraint and displacement constraint, which will be used for 3-D network localization with mixed types of measurements.
II-B Angle Constraint and Displacement Constraint
Lemma 1.
Note that in Lemma 1, means that can be either colinear or non-colinear.
Definition 1.
A wide matrix can be constructed based on five different nodes . From the matrix theory, for any wide matrix , there must be a non-zero vector satisfying , i.e.,
(4) |
where .
Definition 2.
Equation (4) is formally defined as a displacement constraint for node with respect to the edges .
It is worth noting that the angle constraints (1)-(3) are constructed by relative positions rather than angles. Note that the anchor positions are known, that is, the relative positions among the anchors are known. Hence, the angle constraints among the anchors are available. The parameters , , , , , in (1)-(3) are obtained by the relative positions . For example, the parameters and in (1) can be designed as
(5) |
Remark 1.
Since the nodes are not collocated, the case does not hold. Without loss of generality, suppose . The parameters satisfying the angle constraint are not unique, but the ratio of parameters satisfying the angle constraint is unique. The angles between the anchor nodes are determined uniquely by these unique ratios of parameters in the angle constraints (1)-(3).
In this paper, the known anchor positions will be used to construct the angle constraints, which do not need any measurement. In the proposed network localization, the mixed types of measurements are only used for constructing the displacement constraints (4). The details of how to make use of local relative measurements to construct the displacement constraint will be introduced in Section IV-B. Note that network localizability is used to specify whether the corresponding network structure is unique. The following angle-displacement rigidity theory will be used to explore the network localizability.
II-C Angle-displacement Rigidity Theory
A three-dimensional network, represented by , is an undirected graph with its vertex mapped to point , where is the configuration in . The structure of a network can be determined by angle and displacement constraints. A simple example is given in Fig. 1. The structure of the network is determined by three angles and a displacement constraint , where are determined by three angle constraints (1)-(3). Thus, the structure of the network can be decided by three angle constraints (1)-(3) and the displacement constraint . The following angle-displacement rigidity theory answers that the structure of a network in can be uniquely determined by a set of angle and displacement constraints up to directly similar transformations, i.e., translation, rotation, and scaling.
II-C1 Angle-displacement Function
Let with . Based on Definition 2, the displacement function is defined as
(7) |
where , and with . Let and . Then, the angle-displacement function is defined as
(8) |
Remark 2.
Note that different configurations may have different angle-displacement function. The customized angle-displacement function for the configuration may not be applicable to a different configuration , i.e., may not hold.
II-C2 Angle-displacement Rigidity Matrix
The angle-displacement rigidity matrix is defined as
(9) |
Let be a variation of the configuration . If , is called an angle-displacement infinitesimal motion. Since and , the angle-displacement infinitesimal motions include translations, rotations, and scalings. An angle-displacement infinitesimal motion is called trivial if it corresponds to a translation, a rotation and a scaling of the entire network.
Lemma 2.
[18] The trivial motion space for angle-displacement rigidity in is , where is the space formed by translations , is the space formed by rotations, and is the space formed by scalings.
Let
(10) |
where and are, respectively, arbitrary rows of corresponding to displacement constraint and angle constraint shown as
(11) |
(12) |
Definition 3.
[17] A network () is infinitesimally angle-displacement rigid in if all the angle-displacement infinitesimal motions are trivial.
From Lemma 2, we can know that for an infinitesimally angle-displacement rigid network (), the condition holds. Next, we will introduce the problem of network localization with mixed types of measurements.
III Problem Statement
The objective is to develop a distributed algorithm for localizing the positions of all unknown nodes in a network with mixed types of measurements including local relative position, distance, local relative bearing, angle, and ratio-of-distance measurements. Some nodes may measure only distances, while others may measure only local relative bearings, angles, local relative positions, or ratio-of-distances. In addition, we assume that the orientation differences between the local coordinate frames of the nodes and global coordinate frame are unknown.
Consider a static network () in . Suppose the locations of anchor nodes are given and the locations of free nodes are to be estimated . Denote , , and . Denote , , and . Denote as the local coordinate frame of node . Let be the unknown rotation matrix from to , where is the global coordinate frame. Define
(15) |
where is the local relative position in . is the distance. is the local relative bearing. is the angle between and . is the ratio-of-distance between and . Since there are five kinds of measurements in a local coordinate frame, the nodes can be divided into five categories shown as
-
1.
: Node can measure the distance to its neighboring node .
-
2.
: Node can measure the local relative bearing with respect to its neighboring node .
-
3.
: Node can measure the local relative position to its neighboring node .
-
4.
: Node can measure the angle between and , where .
-
5.
: Node can measure the ratio-of-distance between and , where .
Remark 3.
The work in [19] introduces the sensors that can obtain the ratio-of-distance measurements.
Then, the problem of network localization with mixed types of measurements is described below.
Problem 1.
Consider a static network () with an undirected graph , where each node can measure only one of the five kinds of local relative measurements . Given arbitrary initial estimates , develop a distributed localization algorithm for each free node such that
(16) |
where is the estimate of .
Next, the method for network localization with mixed types of measurements is presented.
IV Network Localization with Mixed Types of Measurements
In this paper, we consider an undirected graph. Each node can measure only one of the five types of local relative measurements and different nodes may have different measurement types shown in Fig. 2. Before introducing the main results, the distance-based displacement constraint is introduced.
IV-A Distance-based Displacement Constraint
In this part, we will introduce how to construct the displacement constraint based on the distance measurements. For the node and its neighbors , define distance matrix as
(17) |
The volume of the tetrahedron formed by the nodes can be calculated with distance measurements through Cayley-Menger determinant [20]. That is,
(18) |
Definition 4.
If a node with respect to its neighboring nodes satisfies the following equations
(19) |
then is called the barycentric coordinate of node with respect to the nodes .
For the volume (18), there are two cases:
-
(a)
If , are non-coplanar. The work in [7] provides a way to obtain the barycentric coordinate of node with respect to the nodes by only using the distance measurements shown in Algorithm 1. This algorithm uses the fact that a congruent framework of the subnetwork consisting of the node and its neighbors has the same barycentric coordinate. Note that (19) can be rewritten as a displacement constraint shown as
(20) Algorithm 1 Distance-based Barycentric Coordinate () 1:Available information: Distance measurements among the nodes . Denote as a subnetwork with .2:Based on the distance matrix (17), obtaining a congruent network with by Algorithm in [7], where .3:Based on , calculating the barycentric coordinate of node with respect to its neighboring nodes in (19) by(21) (22) -
(b)
If , are coplanar. The area of the triangle formed by the nodes can also be calculated with distance measurements through Cayley-Menger determinant [20]. That is,
(23)
For the area (23), there are also two cases:
-
(i)
If , are non-colinear. The work in [6] provides a way to obtain the barycentric coordinate of node with respect to its neighboring nodes in (24) by only using the distance measurements shown in Algorithm 2.
(24) Algorithm 2 Distance-based Barycentric Coordinate () 1:Available information: Distance measurements among the nodes .2:The absolute values of the barycentric coordinate are calculated by(26) (27) 3:Calculating by distance measurements through Algorithm in the Diao’ work [6]. -
(ii)
If , are colinear. There are three cases: ; ; . If , we have
(28)
IV-B Construction of Angle Constraints and Displacement Constraints
Assumption 1.
No two nodes are collocated in . Each anchor node has at least two neighboring anchor nodes , where are mutual neighbors. Each free node has at least four neighboring nodes , where are mutual neighbors and non-colinear.
Note that network localizability is used to specify whether the network structure is unique. Since the network structure can be determined by angle constraints and displacement constraints, to analyze network localizability, we need to obtain angle constraints and displacement constraints.
IV-B1 Angle Constraint
IV-B2 Displacement Constraint
Different from the angle constraints that are constructed without any measurement, the local relative measurements will be used to construct the displacement constraints (4). Under Assumption 1, each free node can communicate with its four neighbors . Then, the displacement constraint among can be obtained by the mixed types of measurements. Without loss of generality, we consider two cases: and .
Case . Node . Node can measure local relative positions shown in Fig. 2. In this case, we do not care the measurement types of nodes as their measurements will not be used. Since , there must be a non-zero vector satisfying
(30) |
Note that . Left multiplying on both sides of (30), we can obtain the displacement constraint
(31) |
Case . Node . There are two situations: at least one neighbor of node in , no neighbor of node in .
Case . Consider at least one neighbor of node in , say shown in Fig. 2. Node can obtain from node by communication. Similar to (30) and (31), we can obtain a displacement constraint shown as
(32) |
where the non-zero vector satisfying (32) can be calculated by solving its equivalent equation (33).
(33) |
Remark 4.
For the case , node makes use of node ’s measurements to construct the displacement constraint (32).
Case . Consider no neighbor of node in , that is, . Under Assumption 1, node and its four neighboring nodes are non-colinear. Hence, there must be six triangles among the nodes shown in Fig. 2, where the six triangles are: , , , , , . It is shown in Section IV-A that the parameters in the displacement constraint (31) can be obtained by the distance matrix (17) through Algorithm 3, but the distance matrix (17) is usually unavailable in a network with mixed local relative measurements. We find that the following ratio-of-distance matrix (34) can be obtained by using the mixed local relative measurements.
(34) |
From Lemma 2, we can know that the scaling motions can preserve the invariance of displacement constraint (31), i.e., a network with ratio-of-distance matrix (34) has the same displacement constraint as the network with distance matrix (17). Hence, parameters in (31) can be obtained by the ratio-of-distance matrix (34) through Algorithm 3. Next, we will introduce how to obtain the ratio-of-distance matrix (34) based on the six triangles , , , , , shown in Fig. 2.
We will use triangle as an example to show how to obtain the ratio-of-distances in . In the case , for the triangle with nodes , there are two categories: (a) the nodes have different types of measurements, (b) at least two of the nodes have the same type of measurement.
-
(a)
The nodes have different types of measurements. Since , the following four cases: (a1) , (a2) , (a3) , (a4) , cover all possibilities. Without loss of generality, for the cases (a1) and (a2), suppose node can measure local relative bearings and node can measure angle . Then, we have and . The ratio-of-distances can be obtained by and . For the cases (a3) and (a4), suppose node can measure distances , and node can measure the ratio of distance . The ratio-of-distances can also be obtained.
-
(b)
At least two of the nodes have the same type of measurement. Since , the following four cases: (b1) at least two nodes can measure local relative bearing, (b2) at least two nodes can measure angle, (b3) at least two nodes can measure distance, (b4) at least two nodes can measure ratio-of-distance, cover all possibilities. Without loss of generality, for the case (b1), suppose the nodes can measure local relative bearings and . Then, we have , and . The ratio-of-distances can be obtained by and . For the case (b2), suppose the nodes can measure angles and . Then, we have . The ratio-of-distances can also be obtained by and . For the cases (b3) and (b4) where at least two nodes can measure distance or ratio-of-distance, it is clear that the ratio-of-distances can be obtained.
Hence, the ratio-of-distances in can be obtained by the triangle . The rest ratio-of-distances in can also be obtained by the triangles , , , , , i.e., the ratio-of-distance matrix is available. Then, the displacement constraint (31) can be obtained by the ratio-of-distance matrix (34) through Algorithm 3. The implementation of constructing the displacement constraint is given in Fig. 3.
After obtaining the angle constraints and displacement constraints, we are now ready to formulate the network localization problem and explore the network localizability.
IV-C Network Localizability
The angle constraints are used for describing the distribution of the anchors, and the displacement constraints are used to estimate the free nodes by the known anchor nodes. The network localization problem is formulated as
(35) |
where are the estimates of , and is displacement function (7). If there is a unique solution to (35), the network () is called localizable.
Remark 5.
is the displacement function consisting of available displacement constraints. Since the true positions of all the nodes satisfy , we have if . Hence, the network localization problem is equivalent to minimizing the cost function given the known anchor positions.
From (14), we obtain
(36) |
For the angle function (6) constructed among the known anchors, it yields , i.e., . Then, (36) becomes
(37) |
From (11) and (12), we can know that the matrix are determined by the anchor positions and parameters (such as in (6) and in (7)) in the angle constraints and displacement constraints. Hence, we have . Then, (37) becomes
(38) |
Define information matrix of a network with mixed local relative measurements as
(39) |
which can be partitioned as
(40) |
where , , and . Note that . Based on (38) and (40), (35) can be rewritten as
(41) |
Note that any minimizer in (41) satisfies
(42) |
From (42), we can obtain the algebraic and graph conditions for network localizability shown in the following Theorem 1 and Theorem 2, respectively.
Theorem 1.
Suppose Assumption 1 holds. A network () with mixed types of measurements in is localizable if and only if the matrix is nonsingular.
Proof.
(Sufficiency) From (42), we can know that the matrix must be nonsingular. (Necessity) If the matrix is nonsingular, we have . Since and , we have , that is, . Since is nonsingular, we have . Hence, equals the true positions . ∎
From Theorem 1, we have if a network () with mixed types of measurements is localizable. A simple 3-D localizable network consisting of four anchor nodes , , , and three free nodes , , is given in Fig. 4. Based on the displacement constraints , , and , we can obtain the corresponding matrices and shown as
(43) |
It can be verified that , where and . Hence, the network in Fig. 4 is localizable.
Theorem 2.
Suppose Assumption 1 holds. A 3-D network () with mixed types of measurements is localizable if the following conditions hold:
-
1.
() is infinitesimally angle-displacement rigid;
-
2.
There are at least three non-colinear anchor nodes.
Proof.
From Lemma 2, if () is infinitesimally angle-displacement rigid. Thus, the nonzero angle-displacement infinitesimally motion is
(44) |
where . For the anchor nodes , we have .
-
(a)
First, we will prove by contradiction. If , we have
(45) Since , matrix is a real skew-symmetric matrix and each eigenvalue of is either zero or pure imaginary. If , we have . From (45), we have , i.e., the anchor nodes collocate, which contradicts Assumption 1 that no two anchor nodes are collocated. If , we have , i.e., . From (45), we can know that the anchor nodes are colinear or collocated, which contradicts that no two anchor nodes are collocated and there are at least three non-colinear anchors. Hence, .
-
(b)
Second, we will prove that the matrix is nonsingular if . We only need to show that if the matrix is singular. If the matrix is singular, there must be a nonzero such that . Let with . We have .
Based on (a) and (b), we can know that the matrix must be nonsingular if () is infinitesimally angle-displacement rigid. Hence, () is localizable from Theorem 1. ∎
The graph condition in Theorem 2 is sufficient but not necessary. A 3-D localizable network may not be infinitesimally angle-displacement rigid. As shown in Fig. 4, the anchor nodes are enough to localize the free nodes . If we add additional anchor node with edges and to the network, the network will not be infinitesimally angle-displacement rigid but is still localizable. Next, we will answer the question of how to localize the free node in a distributed way.
IV-D Distributed Localization Algorithm
To achieve distributed network localization, each free node implements the following distributed localization algorithm, i.e.,
(46) |
where
(47) |
and
(48) |
corresponds to the displacement constraint (31) and corresponds to the displacement constraint (32). Based on (46), we have
(49) |
Theorem 3.
Suppose Assumption 1 holds. Under the distributed localization algorithm (46) with arbitrary generated initial estimates, the position estimation errors of the free nodes asymptotically converge to zero if the following conditions hold:
-
1.
() is infinitesimally angle-displacement rigid;
-
2.
There are at least three non-colinear anchor nodes.
Proof.
If there is measurement noise, the measurement noise will influence the parameters in the displacement constraints such as in (7). Note that the matrices and in (49) are only determined by the parameters in the displacement constraints. Hence, the measurement noise will influence matrices and . The noisy and are
(51) |
where are error matrices. Then, we have
(52) |
where is the positions of the free nodes satisfying the noisy measurements and known anchor positions. If the noisy matrix is nonsingular, the solution to (52) is unique.
Lemma 3.
A network () with mixed types of noisy measurements in is localizable if the following conditions hold:
-
1.
() is infinitesimally angle-displacement rigid;
-
2.
The error matrix satisfies
(53)
Proof.
From Theorem 1, is nonsingular if () is infinitesimally angle-displacement rigid. Then, we have . Since , the matrix must be nonsingular if the condition in (53) holds. From (39), we can conclude that must also be positive definite. Then, under the proposed distributed localization algorithm , the estimate will converge to shown as
(54) |
∎
Remark 6.
The condition in (53) is only used to guarantee the noisy matrix to be nonsingular, which is sufficient but not necessary. Hence, the noisy matrix may still be nonsingular even if the condition in (53) does not hold, that is, the network may still be localizable under the proposed scheme even if the condition in (53) does not hold.
From Lemma 2, we can know that the displacement constraints are invariant to the translation of the entire network. If we change the original point of the global coordinate frame or translate the whole network, the matrices will remain unchanged, i.e.,
(55) | ||||
(56) |
where is the original point of any local coordinate frame. If the condition in (53) holds, based on (54) and (56), we have
(57) |
From (57), we can know that the position estimation error remains unchanged if we change the original point of the global coordinate frame or translate the whole network. Actually, the position estimation error is only determined by the noisy measurements and the structure of the network. Then, we can obtain the error bound of position estimates of the free nodes shown as
(58) |
From (58), we can know that the error bound of position estimates can be obtained by minimizing the following cost function.
(59) |
The cost function (59) is a Fermat-Weber location problem, which can be solved by using the method in [21]. Hence, the error bound of position estimates will also remain unchanged even if we change the original point of the global coordinate frame or translate the whole network.
The proposed distributed localization algorithm is implemented in a simultaneous way when the noisy matrix is nonsingular. When the noisy matrix is not nonsingular, the free nodes can still be estimated by using a sequential distributed localization protocol shown in the above Algorithm 4, where there are two kinds of localization algorithms, i.e., (47) and (48).
If , for the localization algorithm (47), consider a Lyapunov candidate , it yields
(60) |
where are the estimates of the localized neighbors . Hence, the estimate of node will converge to . Similarly, if , for the localization algorithm (48), we can know that the estimate of node will converge to
(61) |
In Algorithm 4, to implement the localization algorithm or , node requires at least four localized neighbors, i.e., . Actually, when or , node may also be localizable.
-
(a)
When , node has three localized neighbors . The ratio-of-distance matrix among the nodes can be obtained by the noisy measurements. Based on the ratio-of-distance matrix, we can check whether the nodes are coplanar or the nodes are non-colinear by Menger determinant method shown in (18) and (23). Note that a network with ratio-of-distance matrix has the same barycentric coordinate as the network with distance matrix. Hence, if the nodes are coplanar and the nodes are non-colinear, based on the ratio-of-distance matrix, we can obtain the barycentric coordinate of node with respect to the nodes by Algorithm 2. Thus, the estimate of node can be obtained by its localized neighbors , i.e.,
(62) -
(b)
When , node has two localized neighbors . The ratio of distances and can be obtained by the noisy measurements. If , or , or , the nodes are colinear. Without loss of generility, suppose , we have
(63) Then, the estimate of node can be obtained by its localized neighbors , i.e.,
(64)
IV-E Discussions on the Proposed Method
From Algorithm 2 and (29), we can know any four nodes can form a displacement constraint if they are on the same plane. Hence, 2-D network localizaion with mixed measurements only requires each free node has at least three neighbors rather than four neighbors required for 3-D network. Hence, when the proposed method is applied to 2-D space, the Assumption 1 can be relaxed as
Assumption 2.
No two nodes are collocated. Each anchor node has at least two neighboring anchor nodes , where are mutual neighbors. Each free node has at least three neighboring nodes , where are mutual neighbors and non-colinear.
Remark 7.
From (30), we can know that the graph can be directed if each free node can measure relative positions in its local coordinate frame. In addition, it is possible to apply the proposed method to a switching graph if there exists such that for each time instant , the union network is infinitesimally angle-displacement rigid, where is the union graph during the time interval .
The existing works consider distributed localization with mixed distance and bearing measurements [13, 14, 15], but [13] is limited to 2-D space and [14, 15] need to know the global coordinate frame. Note that each node in [13, 14, 15] can measure both distances and bearings. The more challenging case is that some nodes can only measure distances or bearings. For this case, Lin develops a distributed algorithm for 2-D network localization, where each node can only measure distances, bearings, or relative positions in its local coordinate frame [16]. Compared with his result [16], the advantages of our work are concluded as follows.
- (i)
-
(ii)
The work in [16] only considers three kinds of local relative measurements: local relative position, local relative bearing, and distance, but our work considers five kinds of local relative measurements.
-
(iii)
The difference between the Assumption in [16] and our Assumption 2 is that the work in [16] requires the convex hull assumption, i.e., each node lies strictly inside the convex hull spanned by its neighboring nodes, but our work only requires the free node and its neighbors be non-colinear. It is clear that our Assumption 2 is mild.
V Simulation
Two numerical examples are given to illustrate the effectiveness of the theoretical findings. A three-dimensional localizable network with mixed types of measurements is shown in Fig. 5, where the anchor nodes and free nodes are denoted by large solid dots and small solid dots, respectively. The orientation difference between the local coordinate frame of each node and global coordinate frame is unknown. It can be verified that the network in Fig. 5 is infinitesimally angle-displacement rigid, where the corresponding angle constraints and displacement constraints are constructed by our proposed methods shown in Section IV-B. For example, for the anchor nodes , , and free nodes , shown in Fig. 5, the angle constraints (65) for the anchor nodes are obtained by (5).
(65) |
where
(66) |
For the free node , since it can measure local relative position to its neighboring nodes , the displacement constraint (67) among the nodes are obtained by (30).
(67) |
where
(68) |
When there is no measurement noise, under distributed localization algorithm (46) with randomly generated initial estimate, each free node can estimate its position shown in Fig. 6. The position estimation errors of the free nodes converge to zero globally shown in Fig. 7. In the proposed method, the mixed types of measurements are only used to construct the displacement constraints. Hence, the measurement noises will only influence displacement constraints. For example, when there is measurement noise, the free node obtain the noisy local relative position measurements shown as
(69) |
Then, the displacement constraint with noisy local relative position measurements among the nodes becomes
(70) |
VI Conclusion
This paper studies the 3-D network localization with mixed local relative measurements, where each node holds a local coordinate frame without a common orientation and has no knowledge about the global coordinate frame. The main idea is to construct the displacement constraints for the positions of the nodes by using mixed local relative measurements. A linear distributed algorithm is proposed for each free node that can globally estimate its own position if the network is localizable. Our future work is to relax the assumption and evaluate the estimation error given the statistics of measurements noises.
References
- [1] C. Jiang, Z. Chen, R. Su, and Y. C. Soh, “Group greedy method for sensor placement,” IEEE Transactions on Signal Processing, vol. 67, no. 9, pp. 2249–2262, 2019.
- [2] X. Li, C. Wen, and C. Chen, “Adaptive formation control of networked robotic systems with bearing-only measurements,” IEEE Transactions on Cybernetics, Publised Online, 2020.
- [3] Y. Wei and Z. Lin, “Vision-based tracking by a quadrotor on ros,” Unmanned Systems, vol. 7, no. 04, pp. 233–244, 2019.
- [4] Q. Fan, N. Li, Y. Zhang, and X. Yan, “Zoning search using a hyper-heuristic algorithm,” Science China Information Sciences, vol. 62, no. 9, pp. 1–3, 2019.
- [5] Z. Chen, Q. Zhu, and Y. C. Soh, “Smartphone inertial sensor-based indoor localization and tracking with ibeacon corrections,” IEEE Transactions on Industrial Informatics, vol. 12, no. 4, pp. 1540–1549, 2016.
- [6] Y. Diao, Z. Lin, and M. Fu, “A barycentric coordinate based distributed localization algorithm for sensor networks,” IEEE Transactions on Signal Processing, vol. 62, no. 18, pp. 4760–4771, 2014.
- [7] T. Han, Z. Lin, R. Zheng, Z. Han, and H. Zhang, “A barycentric coordinate based approach to three-dimensional distributed localization for wireless sensor networks,” in 2017 13th IEEE International Conference on Control & Automation (ICCA). IEEE, 2017, pp. 600–605.
- [8] P. Barooah and J. P. Hespanha, “Estimation on graphs from relative measurements,” IEEE Control Systems Magazine, vol. 27, no. 4, pp. 57–74, 2007.
- [9] G. **g, C. Wan, and R. Dai, “Angle-based sensor network localization,” arXiv preprint arXiv:1912.01665, 2019.
- [10] S. Zhao and D. Zelazo, “Localizability and distributed protocols for bearing-based network localization in arbitrary dimensions,” Automatica, vol. 69, pp. 334–341, 2016.
- [11] G. Piovan, I. Shames, B. Fidan, F. Bullo, and B. D. Anderson, “On frame and orientation localization for relative sensing networks,” Automatica, vol. 49, no. 1, pp. 206–213, 2013.
- [12] I. Shames, A. N. Bishop, and B. D. Anderson, “Analysis of noisy bearing-only network localization,” IEEE Transactions on Automatic Control, vol. 58, no. 1, pp. 247–252, 2012.
- [13] Z. Lin, M. Fu, and Y. Diao, “Distributed self localization for relative position sensing networks in 2d space,” IEEE Transactions on Signal Processing, vol. 63, no. 14, pp. 3751–3761, 2015.
- [14] T. Eren, “Cooperative localization in wireless ad hoc and sensor networks using hybrid distance and bearing (angle of arrival) measurements,” EURASIP Journal on Wireless Communications and Networking, vol. 2011, no. 1, p. 72, 2011.
- [15] G. Stacey and R. Mahony, “The role of symmetry in rigidity analysis: A tool for network localization and formation control,” IEEE Transactions on Automatic Control, vol. 63, no. 5, pp. 1313–1328, 2017.
- [16] Z. Lin, T. Han, R. Zheng, and C. Yu, “Distributed localization with mixed measurements under switching topologies,” Automatica, vol. 76, pp. 251–257, 2017.
- [17] X. Fang, X. Li, and L. Xie, “Angle-displacement rigidity theory with application to distributed network localization,” IEEE Transactions on Automatic Control, Published Online, 2020.
- [18] ——, “Technical details of distributed localization,” arXiv preprint arXiv:2007.10672, 2020.
- [19] K. Cao, Z. Han, X. Li, and L. Xie, “Ratio-of-distance rigidity theory with application to similar formation control,” IEEE Transactions on Automatic Control, vol. 65, no. 6, pp. 2598–2611, 2020.
- [20] M. J. Sippl and H. A. Scheraga, “Cayley-menger coordinates,” Proceedings of the National Academy of Sciences, vol. 83, no. 8, pp. 2283–2287, 1986.
- [21] M. H. Trinh, B.-H. Lee, and H.-S. Ahn, “The fermat–weber location problem in single integrator dynamics using only local bearing angles,” Automatica, vol. 59, pp. 90–96, 2015.