Updated mission default frequency.
Updated angles in set heading to respect argument types