Mobile network localization
11536797 · 2022-12-27
Assignee
Inventors
Cpc classification
H04W64/00
ELECTRICITY
International classification
H04L41/046
ELECTRICITY
Abstract
A method localizes a first agent in a network including a number of agents, the number of agents including a number of mobile agents and one or more beacons located at known locations. The method includes performing a procedure including, receiving transmissions from a number of neighboring agents, processing the transmissions to determine information related to a relative location of the first agent and each neighboring agent of the number of neighboring agents, determining, based on the information related to the relative location of the first agent and each neighboring agent, that the first agent is within one or more proximity regions, and updating an estimated location of the first agent based on the information related to a relative location of the first agent and each neighboring agent.
Claims
1. A method for localization of a first agent in a network including a plurality of agents, the plurality of agents including a plurality of mobile agents and one or more beacons located at known locations, the method comprising: performing a procedure including, receiving transmissions from a plurality of neighboring agents; processing the transmissions to determine information related to a relative location of the first agent and each neighboring agent of the plurality of neighboring agents; determining, based on the information related to the relative location of the first agent and each neighboring agent, that the first agent is within one or more proximity regions; and updating an estimated location of the first agent based on the information related to a relative location of the first agent and each neighboring agent.
2. The method of claim 1 further comprising determining that a number of neighboring agents in the plurality of neighboring agents exceeds a threshold required to form the one or more proximity regions.
3. The method of claim 1 wherein the information related to the relative location of the first agent and each neighboring agent includes distance information.
4. The method of claim 1 wherein the information related to the relative location of the first agent and each neighboring agent includes directional information.
5. The method of claim 1 wherein each proximity region is formed as a convex hull formed according to locations of three or more agents of the plurality of neighboring agents.
6. The method of claim 1 further comprising repeatedly performing the procedure until an error threshold is met.
7. The method of claim 1 further comprising maintaining, at each mobile agent, an estimate of a direction and distance traveled location relative to a previous location.
8. The method of claim 7 wherein the previous location is an initial location.
9. The method of claim 1 wherein at least one of the proximity regions is determined based on a location of a first neighboring agent of the plurality of neighboring agents at a first time and a location of a second neighboring agent of the plurality of neighboring agents at a second time.
10. The method of claim 1 wherein at least one agent of the plurality of neighboring agents is a beacon.
11. The method of claim 1 wherein determining whether the first agent is included in one or more proximity regions includes determining barycentric coordinates of the first agent in the one or more proximity regions.
12. The method of claim 1 wherein the one or more beacons consists of a single beacon.
13. The method of claim 1 wherein the one or more proximity regions includes a plurality of proximity regions.
14. The method of claim 1 wherein at least some beacons of the one or more beacons is located at a fixed location.
15. A method for localization of a first agent in a network including a plurality of agents, the plurality of agents including a plurality of mobile agents and one or more beacons located at known locations, the method comprising: performing a procedure including, receiving transmissions from a plurality of neighboring agents; processing the transmissions to determine information related to a relative location of the first agent and each neighboring agent of the plurality of neighboring agents; determining, based on the information related to the relative location of the first agent and each neighboring agent, that the first agent is within one or more proximity regions; and updating an estimated location of the first agent based on the information related to a relative location of the first agent and each neighboring agent, wherein the updating an estimated location of the first agent includes performing a linear update operation.
16. The method of claim 15 wherein the linear update operation includes a linear-convex combination of the information related to a relative location of the first agent and each neighboring agent.
Description
DESCRIPTION OF DRAWINGS
(1)
(2)
(3)
(4)
(5)
(6)
(7)
(8)
(9)
(10)
(11)
(12)
(13)
DESCRIPTION
(14) Referring to
(15) In some examples, a distributed algorithm is used to determine localization of the robots 102. In the distributed algorithm, each of the robots 102 measures a possibly noisy version of its motion (e.g., using dead reckoning techniques) and a possibly noisy version of its relative location (e.g., distance and/or direction) to neighboring robots (e.g., using Received Signal Strength Indicator (RSSI), Time of Arrival (TOA), Time Distance of Arrival (TDoA), or camera based techniques). The distributed algorithm iteratively and linearly updates the locations of the robots based on the measured motion of the robots and the measured distances between the robots. One version of the equation for updating the location estimates for the robots 102 is:
(16)
(17) In the above equation, x.sub.k.sup.j is the location estimate of an i.sup.th robot at a time k, Θ.sub.i(k) represents a triangulation set consisting of the nodes that form a convex hull in which the i.sup.th robot is located at time k, a.sub.k.sup.ij are the barycentric coordinates of the i.sup.th robot with respect to the j.sup.th node of the convex hull in which the i.sup.th robot is located at time k, and α.sub.k is a parameter defined as:
(18)
where β is a design parameter.
(19) For each of the robots 102, the update equation shown above is applied only when the robot lies within a convex hull of m+1 neighbors (i.e., robots, beacons, or a mixture of robots and beacons), where m is the dimension of the space in which the robot's location is being determined. That is, if m=3, the location of a given robot is being determined in three dimensions, so the robot must exist in a convex hull of four neighbors for an update of the robot's location to be performed. Generally, the convex hull inclusion test is defined as:
(20)
where C(⋅) denotes a convex hull, i denotes the i.sup.th robot, “\” denotes the set difference, and A.sub.Θ.sub.
(21) The true location of the i.sup.th robot with respect to the neighboring robots of the triangulation set Θ.sub.i(k) is represented using barycentric coordinates as follows:
(22)
where x.sub.k.sup.i* is the location of robot i at time k and the a.sub.k.sup.ij's are barycentric coordinates defined as:
(23)
(24) Based on the above, the location update formula includes a linear-convex combination of the locations of the neighboring robots of the triangulation set Θ.sub.i(k) rather than a complex nonlinear function. Since the update equation is linear, the distributed localization algorithm is guaranteed to converge on the locations of the robots regardless of the initial conditions (i.e., the initial location estimates for the robots).
1 Inclusion Test
(25) Referring to .sup.k) form a convex hull around the i.sup.th robot.
(26) In an exemplary two-dimensional case, a convex hull can be formed as a triangle with three of the i.sup.th robot's neighbors at its vertices. For example, in the exemplary embedding of .sup.k (i.e., the second robot, R2, the third robot, R3, and the fourth robot, R4) at its vertices is computed. For each unique pair of the first robot's neighbors (i.e., (R2, R3), (R2, R4), and (R3, R4)) an area of triangle with the pair of neighbors and the first robot, R1 is computed, resulting in three areas, A.sub.123, A.sub.124, and A.sub.134. If
A.sub.123+A.sub.124+A.sub.134=A.sub.234
then the first robot, R1 212 is included in the convex hull formed by the second robot, R2 214, the third robot, R3 216, and the fourth robot, R4 218 (as is shown in
A.sub.123+A.sub.124+A.sub.134>A.sub.234
then the first robot, R1 212 is not included in the convex hull formed by the second robot, R2 214, the third robot, R3 216, and the fourth robot, R4 218 (as is shown in
(27) As the number of dimensions, m in the system changes, the inclusion test also changes. For example, in a three-dimensional case, the convex hulls are formed as tetrahedrons and the inclusion test includes a comparison similar to that described for the two-dimensional case but using volumes rather than areas.
2 Determination of Embedding
(28) In general, to perform the above-described inclusion test, an embedding of the i.sup.th robot and its neighbors needs to be known (either explicitly or implicitly). In some approaches, the distances and angles (relative to a common reference frame) between the i.sup.th robot and its neighbors as well as the distances and angles between each pair of the neighbors are known to the i.sup.th robot. With both distances and angles known, the embedding of the i.sup.th robot and its neighbors is easily obtained.
(29) In one aspect, only the pairwise distances between the i.sup.th robot and its neighbors and the pairwise distances between each pair of the i.sup.th robot's neighbors are known (i.e., the angles between the robots are unknown), resulting in N.sup.2 pairwise distances, where N is the number of robots in the neighborhood, including the i.sup.th robot.
(30) With only pairwise distances between the robots known, determination of the embedding of the nodes can be characterized as the distance geometry problem. Any one of a number of techniques for estimating a solution to the distance geometry solution can be used to determine an embedding of the nodes. Once an embedding is determined, the inclusion test described above can be used to identify if a given robot is in a given convex hull. It is noted, however that with only the N.sup.2 pairwise distances available, there are insufficient degrees of freedom for determining a unique embedding of the robots. For example, rigid transformations such as rotations and reflections of the embedding are possible. The inclusion test is unaffected by such rigid transformations and is able to determine a set of zero or more convex hulls from the embedding.
(31) In some aspects, the step of determining an explicit embedding for the robots in the m-dimensional space is bypassed and the areas or volumes associated with a robot and a convex hull required for performing the inclusion test are determined directly from the pairvise distances between the it robot and the robots that make up the convex hull. One way of determining the areas or volumes includes finding the Cayley-Menger determinant for each convex hull that can be made from the i.sup.th robot and the robots of the i.sup.th robot's set of neighbors, .sup.k.
(32) In particular, the Cayley-Menger determinant is able to find an area or volume of a convex hull given the pairwise distances between the m+1 vertices of the convex hull. Thus, to determine the areas or volumes required to perform the inclusion test for a given set of neighbors, .sub.i.sup.k and an i.sup.th robot, the Cayley-Menger determinant is used to find: The area or volume associated with the convex hull formed by the set of neighbors,
.sub.i.sup.k of the i.sup.th robot, and The areas or volumes associated with each convex hull that can be formed by the i.sup.th robot and a unique combination of m neighbors selected from the set of neighbors,
.sub.i.sup.k.
(33) The above areas or volumes determined by the Cayley-Menger determinant are used to perform the inclusion test to determine whether the i.sup.th robot is included in the given set of neighbors, .sub.i.sup.k. If the inclusion test passes, the set of neighbors,
.sub.i.sup.k form a triangulation set, Θ.sub.i(k).
3 Algorithm
(34) Referring to
4 Example
(35) Referring to
(36) Referring to
(37) Referring to
(38) Referring to
5 Minimum Beacon Contribution
(39) Since true information is only injected into the network by the beacons, a strictly positive lower bound must be assigned to the weights corresponding to the beacons. Otherwise, the beacons may be assigned a weight that goes to zero over time, i.e., the beacons eventually are excluded from the network.
(40) For example, referring to .sub.1.sup.k (i.e., the beacon, B1 814, the third robot, R3 816, and the fourth robot, R4 818).
(41) When the first robot, R1 812 attempts to update its location, the area A134 indicates that a contribution to the location estimate for the first robot, 812 made by the beacon, B1 814 is equal to a predefined minimum allowed value. For example, A134 equals ¼ of the total area of the convex hull, and the predefined minimum allowed contribution value is α=0.25. The first robot, R1 812 is allowed to update its location estimate.
(42) Referring to
(43) Referring to
6 Virtual Convex Hulls
(44) In another aspect, the location of a given robot is updated even though it is never physically present in a convex hull. For example, the robot may never be in the vicinity of a sufficient number of neighboring robots for performing the inclusion test (i.e., the robot only ever encounters fewer than m+1 neighbors). Even in the case where the robot does encounter m+1 or greater neighbors, it may never pass the inclusion test.
(45) The concept of virtual convex hulls relies on the fact that a robot may encounter a number of other robots over time. While at no time is the robot ever physically present inside a convex hull, it can store distance and angle information from its encounters with other robots over time and build a convex hull out of that stored history information. Such a convex hull is referred to as a virtual convex hull since all of the robots whose past distance and angle information is used to build this convex hull may have traveled to arbitrary locations in the network. The robot also maintains a record of its motion such that when the robot moves into a virtual convex hull, it is able to perform an update of its location as if it were inside an actual physical convex hull.
(46) For example, referring to ,
, move through time steps k=1 . . . 9 (with the time-indices marked inside the robot symbols). Referring to
at k=4, and robot
at k=6.
(47) Referring to }, and V◯(6)={□,
,
}, becomes available. However, robot ◯ does not lie in corresponding convex hull, (V ◯(6)), and cannot update its location estimate with the past estimates of its neighbor's locations.
(48) Robot ◯ must therefore wait until it either moves inside the convex hull of □, or finds another agent with which the convexity condition is satisfied. For example, referring to
7 Localization with a Single Beacon
(49) In another aspect, localization is possible in a network with a single beacon, given that the beacon and the robots are mobile. In particular, with only a single, stationary beacon, the localization algorithm would not be able to fully resolve the location of the robots due to an inability to resolve an angle of rotation of the robot locations about the beacon's known location. However, since the robot is mobile, a vector of its motion can be used to resolve the angle of rotation of the robot locations about the beacon's known location.
(50) For example, a subspace of motion at robot, i∈Ω, and beacon j∈k is denoted by and
.sub.j, respectively. Suppose a robot 1 is moving along a vertical line. This line forms
.sub.1, and dim
.sub.1=1. Note that
.sub.i or
.sub.j includes all possible locations that the i.sup.th robot or the j.sup.th beacon occupies throughout the localization process, i.e., discrete times k=1, 2, . . . . Now consider another robot 2, which is moving along a vertical line parallel to
.sub.1. In this case dim∪.sub.i=1,2
.sub.i=dim
.sub.2=1. However, if the two lines are linearly independent, they span
.sup.2, and have dim∪.sub.i=1,2
.sub.i=dim
.sub.2=2.
(51) Assuming .sup.m, the motion of the robots and beacons in l≤m dimensions allows reduction of the number of beacons from m+1 by l. Note that the traditional trilateration scheme requires at least 3 nodes with known locations in
.sup.2. Therefore, assuming m+1 beacons in
.sup.m has been standard in many conventional multilateration-based localization algorithms. Aspects described herein provide robots with up to m degrees of freedom in their motion in
.sup.m, and the localization algorithm works in the presence of only one (i.e., m+1−m) beacon.
8 Noise Mitigation
(52) In some examples, the techniques used to measure the distances (and possibly angles) between the robots in the network are noisy which can result in unbounded errors in the location estimates of the robots in the network. When an inclusion test is performed to determine whether an i.sup.th robot is in a convex hull due to the noise in distance/motion measurements, there is a possibility that the i.sup.th robot will be erroneously classified as being included (or excluded) in the convex hull. For example, if the i.sup.th robot is located within a range of the error in the boundary of the convex hull. In some aspects, the error in the boundary of the convex hull is estimated (e.g., based on an estimate of the measurement noise) and the i.sup.th robot's location estimate is updated only if the robot is not in the range of the convex hull's boundary error.
(53) In some examples, two different models are used to examine the effects of noise on the localization algorithm. First, the noise on odometry measurements (i.e., the distance and angle that robot i travels at time k) is assumed to be Gaussian with zero mean and the following variances:
σ.sub.d.sup.i2=K.sub.d.sup.2D.sub.k.sup.i,σ.sub.θ.sup.i2=K.sub.θ.sup.2D.sub.k.sup.i
where D.sub.k.sup.i represents the total distance that robot i has traveled up to time k. The noise on the distance measurement (to a neighboring robot) is assumed at time k to be normal with zero mean and the variance of σ.sub.r.sup.i2=K.sub.r.sup.2 k. Therefore, the variances of the odometry measurements are proportional to the total distance a robot has traveled, and the variance on the distance measurements (to the neighboring robots) increases with time. For a network with one beacon and 100 robots, setting K.sub.d=K.sub.θ=K.sub.r=5*10.sup.−3 leads to an unbounded error, which is due to incorrect inclusion test results and the continuous location drifts because of the noise on the distance measurements and the noise on motion, respectively. However, for aspects of the algorithm that are modified to ensure that the i.sup.th robot's location estimate is updated only if the robot is not in the range of the convex hull's boundary error, localization error is bounded by the communication radius. In a simulation with noise ε=20%, i.e., a robot performs an update only if the relative inclusion test error, corresponding to the candidate triangulation set is less than 20%.
9 Implementations
(54) The approaches described above may be used with a variety of free-space transmission techniques. For example, radio-frequency transmissions may be emitted from agents and received at the neighbors, with these radio frequency transmissions explicitly encoding or implicitly identifying the transmitting station. In some examples, a distance may be estimated based on a signal strength of the received transmission. In some examples a direction of arrival may be determined using multiple receiving antennas. In some examples, agents transmit autonomously, while in other examples, they respond to triggering transmissions from other agents. Other types of transmissions, including acoustic (e.g., ultrasound) and optical transmissions may be used. For example, with acoustic transmissions, the propagation time may be used to estimate distance. In some examples, a combination of transmission technologies may be used, for example, with optical transmissions triggering acoustic transmissions from agents. Whatever the transmission technology used, each agent has a suitable receiver to receive transmissions from neighboring agents, and a suitable computation device to determine information related to relative location of the neighboring agents based on the received transmission.
(55) The approaches described above can be implemented, for example, using a programmable computing system executing suitable software instructions or it can be implemented in suitable hardware such as a field-programmable gate array (FPGA) or in some hybrid form. For example, in a programmed approach the software may include procedures in one or more computer programs that execute on one or more programmed or programmable computing system (which may be of various architectures such as distributed, client/server, or grid) each including at least one processor, at least one data storage system (including volatile and/or non-volatile memory and/or storage elements), at least one user interface (for receiving input using at least one input device or port, and for providing output using at least one output device or port). The software may include one or more modules of a larger program, for example, that provides services related to the design, configuration, and execution of data processing graphs. The modules of the program (e.g., elements of a data processing graph) can be implemented as data structures or other organized data conforming to a data model stored in a data repository.
(56) The software may be stored in non-transitory form, such as being embodied in a volatile or non-volatile storage medium, or any other non-transitory medium, using a physical property of the medium (e.g., surface pits and lands, magnetic domains, or electrical charge) for a period of time (e.g., the time between refresh periods of a dynamic memory device such as a dynamic RAM). In preparation for loading the instructions, the software may be provided on a tangible, non-transitory medium, such as a CD-ROM or other computer-readable medium (e.g., readable by a general or special purpose computing system or device), or may be delivered (e.g., encoded in a propagated signal) over a communication medium of a network to a tangible, non-transitory medium of a computing system where it is executed. Some or all of the processing may be performed on a special purpose computer, or using special-purpose hardware, such as coprocessors or field-programmable gate arrays (FPGAs) or dedicated, application-specific integrated circuits (ASICs). The processing may be implemented in a distributed manner in which different parts of the computation specified by the software are performed by different computing elements. Each such computer program is preferably stored on or downloaded to a computer-readable storage medium (e.g., solid state memory or media, or magnetic or optical media) of a storage device accessible by a general or special purpose programmable computer, for configuring and operating the computer when the storage device medium is read by the computer to perform the processing described herein. The inventive system may also be considered to be implemented as a tangible, non-transitory medium, configured with a computer program, where the medium so configured causes a computer to operate in a specific and predefined manner to perform one or more of the processing steps described herein.
(57) A number of embodiments of the invention have been described. Nevertheless, it is to be understood that the foregoing description is intended to illustrate and not to limit the scope of the invention, which is defined by the scope of the following claims. Accordingly, other embodiments are also within the scope of the following claims. For example, various modifications may be made without departing from the scope of the invention. Additionally, some of the steps described above may be order independent, and thus can be performed in an order different from that described.
(58) Additional embodiments and/or detailed description of aspects of the above-described embodiments can be found in the following published documents, the contents of which are included in U.S. Provisional Application Ser. No. 62/417,751, to which this application claims priority. The documents in the following list are incorporated herein by reference. Sam Safavi, Usman Khan. “An opportunistic linear-convex algorithm for localization in mobile robot networks.” IEEE Transactions on Robotics, vol. 33, issue 4, April 2017. Sam Safavi, Usman Khan. “Localization in mobile networks via virtual convex hulls.” IEEE Transactions on Signal and Information Processing over Networks, vol. PP, issue 99, February 2017. Sam Safavi, Usman Khan. “A distributed range-based algorithm for localization in mobile networks.” Asilomar Conference on Signals, Systems and Computers, November 2016. Sam Safavi, Usman Khan. “On the convergence of time-varying fusion algorithms: Application to localization in dynamic networks.” IEEE 55th Conference on Decision and Control, December 2016.
(59) It is to be understood that the foregoing description is intended to illustrate and not to limit the scope of the invention.