Kalman based sensor fusion using images and mechanical sensors