Implementation of grid filter using bayes rule complete, will correctly converge on occupied/not occupied as reading come in