First working beta. Uses calculated orientation. Tracks total angle
turned. Estimates floor location.