Cooperative Aircraft Navigation

A UAS may use camera-captured ground feature data to iteratively estimate pose change through a Kalman filter. To avoid excessive drift, the UAS may periodically perform a reset by publishing delta pose and covariance as an edge in a global pose graph, by zeroing out the delta pose and covariance. To further improve global pose estimation, two UASs may share range information and associated pose graph information, thereby providing an additional constraint for each UAS to use in its pose graph optimization.