Fixed up return value handling and added test for setting waypoint target and clearing waypoints
Rationalised debugging logic, added mission_clear_all logic, added mission_set_current, tidied up ack logic