Smooth Turns for Survey Waypoint Missions

Also experimenting with MIS_YAW_ERR values of 12-90deg. Not sure yet if this helps or hurts. I will update if I find a value/range of values that seem useful.