missionlib: Added geo.h include, 

without this the _wrap_pi function returned garbage (e.g. for the yaw setpoint in auto)