changed drift effect on measurement
fixed wrong orientation in kalman filtered simulation
added spherical coordinate display