Systems and methods for GNSS SNR probabilistic localization and 3-D mapping
Various embodiments each include at least one of systems, methods, devices, and software for GNSS simultaneous localization and mapping (SLAM). The disclosed techniques demonstrate that simultaneous localization and mapping (SLAM) can be performed using only GNSS SNR and geo-location data, collectively termed GNSS data henceforth. A principled Bayesian approach for doing so is disclosed. A 3-D environment map is decomposed into a grid of binary-state cells (occupancy grid) and the receiver locations are approximated by sets of particles. Using a large number of sparsely sampled GNSS SNR measurements and receiver/satellite coordinates (all available from off-the-shelf GNSS receivers), likelihoods of blockage are associated with every receiver-to-satellite beam. Loopy Belief Propagation is used to estimate the probabilities of each cell being occupied or empty, along with the probability of the particles for each receiver location.
1. A probabilistic global navigation satellite system (GNSS) method, the method comprising:
receiving input GNSS data from one or more GNSS data devices, wherein receiving the input GNSS data includes:
receiving a plurality of predicted satellite coordinates;
receiving a plurality of measured signal-to-noise ratio (SNR) values; and
receiving a plurality of estimated receiver locations
generating a navigation output based on a probabilistic simultaneous localization and mapping (SLAM) that utilizes ray tracing between the plurality of estimated receiver locations and the plurality of predicted satellite coordinates along with one or more of the plurality of measured SNR values to determine mapping estimates for a plurality of 3-D locations within a 3-D occupancy map; and
storing, in a tangible storage medium, the navigation output, which includes the plurality of 3-D locations within the 3-D occupancy map.
2. The probabilistic GNSS method of claim 1 , wherein the probabilistic SLAM assigns line-of-sight (LOS) or non-LOS (NLOS) likelihoods for each ray trace between the plurality of receiver locations and the plurality of satellite coordinates based on the measured SNR values associated with each ray trace.
3. The probabilistic GNSS method of claim 1 , wherein:
receiving the input GNSS data includes receiving GNSS data corresponding to a plurality of GNSS users;
generating the navigation output based on the probabilistic SLAM includes determining a plurality of location estimates, the plurality of location estimates corresponding to the plurality of GNSS users; and
storing the navigation output includes storing the plurality of location estimates.
4. The probabilistic GNSS method of claim 1 , wherein generating the navigation output based on the probabilistic SLAM includes generating the navigation output based on belief propagation.
5. The probabilistic GNSS method of claim 1 , wherein generating the navigation output is based on a plurality of prior map occupancy probabilities.
6. The probabilistic GNSS method of claim 1 , wherein receiving the input GNSS data further includes receiving a plurality of GNSS receiver position uncertainty values.
7. The probabilistic GNSS method of claim 1 , wherein generating the navigation output is based on an SNR measurement model, the SNR measurement model describing an expected relationship between a plurality of SNR measurements and a plurality of LOS/NLOS likelihoods.
8. A probabilistic global navigation satellite system (GNSS) method, the method comprising:
receiving an input GNSS data from one or more GNSS data devices;
generating a navigation output based on a probabilistic simultaneous localization and mapping (SLAM); wherein generating the navigation output based on the probabilistic SLAM includes:
updating a plurality of receiver state particles;
updating a plurality of particle weights, wherein updating the plurality of particle weights is based on a measurement model;
updating a plurality of map particles, wherein updating the plurality of map particles includes;
updating a plurality of prior cells with a log-odds occupancy probability;
updating a current cell with an inverse sensor model when the current cell is associated with an intersected cell;
updating a 3-D occupancy map with the log-odds occupancy probability; and
outputting the 3-D occupancy map; and
storing, in a tangible storage medium, the navigation output.
9. A device comprising:
at least one processor;
at least one memory; and
an instruction set, stored in the at least one memory and executable by the at least one processor to perform data processing activities, the data processing activities comprising:
receiving an input global navigation satellite system (GNSS) data;
generating a navigation output based on probabilistic simultaneous localization and mapping (SLAM), wherein generating the navigation output based on probabilistic SLAM includes:
constructing a Bayesian network factor graph, the Bayesian network factor graph including a plurality of Bayesian network factor graph nodes; and
determining mapping estimates for a plurality of 3-D locations within a 3-D occupancy map, the determining of mapping estimates including an application of belief propagation to pass messages between Bayesian network factor graph nodes; and
storing, in the least one memory, the navigation output.
10. The device of claim 9 , wherein:
generating the navigation output based on the probabilistic SLAM includes determining mapping estimates for a plurality of 3-D locations within a 3-D occupancy map; and
storing the navigation output includes storing the plurality of 3-D locations within the 3-D occupancy map.
11. The device of claim 9 , wherein
receiving the input GNSS data includes receiving GNSS data corresponding to a plurality of GNSS users;
generating the navigation output based on the probabilistic SLAM includes determining a plurality of location estimates, the plurality of location estimates corresponding to the plurality of GNSS users; and
storing the navigation output includes storing the plurality of location estimates.
12. The device of claim 9 , wherein constructing the Bayesian network factor graph includes:
tracing a plurality of rays through a plurality of voxels within a volumetric map, each of the plurality of rays representing a GNSS satellite ray from a GNSS receiver position to each of a plurality of GNSS satellites;
storing a plurality of occupancy probabilities associated with each of the plurality of voxels within the volumetric map, each of the plurality of occupancy probabilities indicating a likelihood that each of the plurality of voxels is occupied by an obstruction; and
associating a line-of-sight/non-line-of-sight (LOS/NLOS) probability with each of the plurality of rays.
13. A probabilistic global navigation satellite system (GNSS) method, the method comprising:
receiving an input GNSS data from one or more GNSS data devices;
generating a navigation output based on a Bayesian shadow matching,
wherein generating the navigation output based on the Bayesian shadow matching includes:
constructing a Bayesian network factor graph, the Bayesian network factor graph including a plurality of Bayesian network factor graph nodes; and
determining mapping estimates for a plurality of 3-D locations within a 3-D occupancy map, the determining mapping estimates including an application of belief propagation to pass messages between Bayesian network factor graph nodes; and
storing, in a tangible storage medium, the navigation output.
14. The probabilistic GNSS method of claim 13 , wherein generating the navigation output based on the probabilistic SLAM includes generating the navigation output based on belief propagation.
15. The probabilistic GNSS method of claim 13 , wherein constructing the Bayesian network factor graph includes:
tracing a plurality of rays through a plurality of voxels within a volumetric map, each of the plurality of rays representing a GNSS satellite ray from a GNSS receiver position to each of a plurality of GNSS satellites;
storing a plurality of occupancy probabilities associated with each of the plurality of voxels within the volumetric map, each of the plurality of occupancy probabilities indicating a likelihood that each of the plurality of voxels is occupied by an obstruction; and
associating a line-of-sight/non-line-of-sight (LOS/NLOS) probability with each of the plurality of rays.
16. The probabilistic GNSS method of claim 13 , wherein Bayesian shadow matching includes determining a sequence of improved position estimates.
17. The probabilistic GNSS method of claim 13 , wherein Bayesian shadow matching includes applying a particle filter while holding map estimates constant.