updated vis
reduced number of matrix inversion in sensor model