Hey. I'd be happy to work on this for you. I'm a lecturer in Artificial Intelligence and Machine Learning, and my background is in Robotics, so these kinds of sensor model/Bayesian belief propogation problems are right up my alley ;)
Please get in touch if you'd like to talk about specifics!
Thanks!!