fixed index out of range problem with raycasting. still slow though!
fixed the estimated readings function to be slightly less horrible
demo on monday, sort of working particle filter