Removing median filter for angle. Fine tuning position accuracy.