Chain
A distributed control system and method for decentralized, collaborative platform navigation, routing, and/or control are disclosed employing a distributed, factorized positioning, navigation, and timing chain that can link platforms or nodes having local sensors together by their local inertial and ranging measurements. In the distributed, factorized PNT chain, each platform maintains and contributes local measurements as states to a set of dynamically assigned parent node for a platform cluster, each parent nodes and associated clusters links to at least one other parent node aggregates the states of the platforms in the cluster and passes/propagates states of a linked clustered.
1 . A system comprising:
a first platform comprising:
one or more position or inertial sensors;
one or more ranging sensors, including a first ranging sensor; and
a controller having one or more processors and memory, the memory having instructions stored thereon, wherein the instructions, when executed by the one or more processors of the first platform, cause the one or more processors to:
receive sensor measurements from the one or more inertial sensors and the one or more ranging sensors;
receive a message from a second platform of a plurality of platforms, wherein the message comprises a second set of estimated states of one or more platforms that are included in a first cluster associated with the first platform and a second cluster associated with the second platform, wherein the second cluster includes the second platform and a set of neighboring platforms of the second platform;
determine at least one of position, velocity, and inertial values for the first platform using the received sensor measurements and the message;
determine, via a distributed estimation algorithm, a first set of estimated states corresponding to the first cluster which includes the first platform and a set of neighboring platforms of the first platform including a first neighboring platform, wherein the first set of estimated states form a subgraph of a complete graph, and wherein the complete graph corresponds to the plurality of platforms; and
execute control operations to adjust at least one of position, velocity, navigation, steering, or a combination thereof of the first platform using the first set and the second set of estimated states to maintain position or relative position or movement with at least the set of neighboring platforms of the second platform.
2 . The system of claim 1 , wherein the instructions, when executed by the one or more processors of the first platform, further cause the one or more processors to:
transmit the first set of estimated states, or a portion thereof, for the first platform and the set of neighboring platforms to the first neighboring platform, wherein the transmitted first set of estimated states are combined by the first neighboring platform with other shared estimated states of other neighboring platforms to determine positioning, navigation and timing information for the first neighboring platform.
3 . The system of claim 1 , wherein the distributed estimation algorithm comprises a distributed Kalman Filter generated via a graph factorization operation.
4 . The system of claim 1 , wherein the first set of estimated states includes a set of state values, and the message includes a portion of the first set of estimated states.
5 . The system of claim 1 , wherein the instructions, when executed by the one or more processors of the first platform, further cause the one or more processors to:
establish pairing among the first platform and the second platform; and
re-establish, at pre-defined time or criteria, pairing among the first platform and another platform of the plurality of platforms.
6 . The system of claim 5 , wherein re-establishing the pairing among the first platform and another platform of the plurality of platforms includes disconnecting the among the first platform and the second platform.
7 . The system of claim 1 , wherein the first platform further comprises a GPS receiver configured to determine a GPS-derived position of the first platform, the GPS-derived position being employed to provide positioning data to the distributed estimation algorithm.
8 . The system of claim 1 , wherein the one or more ranging sensors include an altimeter, the altimeter being configured to determine an altitude-derived position of the first platform, the altitude-derived position being employed to provide positioning data to the distributed estimation algorithm.
9 . The system of claim 1 , wherein the first set of estimated states are employed to determine a position data for the first platform, wherein the position data is compared to GPS data derived by the first platform, and wherein the comparison is employed to detect an anomaly associated with the GPS data.
10 . The system of claim 1 , wherein the one or more ranging sensors includes a wireless network communication interface.
11 . The system of claim 1 , wherein the one or more ranging sensors are configured to interrogate with IR waveform, laser pulse, radio-frequency waveform, microwave pulse, or acoustic waveform.
12 . The system of claim 1 , wherein the first platform comprises an unmanned vehicle or manned vehicle.
13 . The system of claim 1 , wherein the first platform comprises an unmanned aerial vehicle.
14 . The system of claim 1 , wherein the first platform and the second platform are the same type.
15 . The system of claim 1 , wherein the first platform and the second platform are different types.
16 . A method comprising:
providing a first platform and a second platform each comprising (i) one or more position or inertial sensors, (ii) one or more ranging sensors, including a first ranging sensor, and (iii) a controller to execute a decentralized, collaborative navigation operation for a network of platforms;
at the first platform,
receiving a sensor measurement from the one or more inertial sensors and the one or more ranging sensors;
receiving a message from the second platform of a plurality of platforms, wherein the message comprises a second set of estimated states of one or more platforms that are included in a first cluster associated with the first platform and a second cluster associated with the second platform, wherein the second cluster includes the second platform and a set of neighboring platforms of the second platform;
determining at least one of position, velocity, and orientation values for the first platform using the received sensor measurement and the message;
determining, via a distributed estimation algorithm, a first set of estimated states corresponding to the first cluster which includes the first platform and a set of neighboring platforms of the first platform including a first neighboring platform, wherein the first set of estimated states form a subgraph of a complete graph, and wherein the complete graph corresponds to the plurality of platforms; and
executing control operations to adjust at least one of position, velocity, navigation, steering, or a combination thereof of the first platform using the first set and the second set of estimated states to maintain position or relative position or movement with at least the set of neighboring platforms of the second platform.
17 . The method of claim 16 , further comprising:
at the first platform, transmitting the first set of estimated states, or a portion thereof, for the first platform and the set of neighboring platforms to the first neighboring platform, wherein the transmitted estimated states are combined by the first neighboring platform with other shared estimated states of other neighboring platforms to determine positioning, navigation and timing information for the first neighboring platform.
18 . The method of claim 16 , wherein the distributed estimation algorithm comprises a distributed Kalman Filter generated via a graph factorization operation.
19 . The method of claim 16 , further comprising:
at the first platform, establishing pairing among the first platform and the second platform; and
re-establishing, at pre-defined time or criteria, pairing among the first platform and another platform of the plurality of platforms.
20 . A non-transitory computer readable medium having instructions stored thereon, wherein the instructions when executed by a controller of a first platform cause the controller to:
receive (i) a message and (ii) a sensor measurement from a second platform of a plurality of platforms, wherein the message comprises a second set of estimated states of one or more platforms that are included in a first cluster associated with the first platform and a second cluster associated with the second platform, wherein the second cluster includes the second platform and a set of neighboring platforms of the second platform;
determine at least one of position, velocity, and orientation values for the first platform using the received sensor measurement and the message;
determine, via a distributed estimation algorithm, a first set of estimated states corresponding to the first cluster which includes the first platform and a set of neighboring platforms of the first platform including a first neighboring platform, wherein the first set of estimated states form a subgraph of a complete graph, and wherein the complete graph corresponds to the plurality of platforms; and
execute control operations to adjust at least one of position, velocity, navigation, steering, or a combination thereof of the first platform using the first set and the second set of estimated states to maintain position or relative position or movement with at least the set of neighboring platforms of the second platform.