Added a little bit of the sensor probability estimation, but it's clearly broken