missionlib: Added geo.h include, without this the _wrap_pi function returned garbage (e.g. for the yaw setpoint in auto)