new update_soaring() function for scheduler

Moved code out of update_flight_mode() and into dedicated
update_soaring() function which is called by scheduler at 5Hz
cleaned up ardusoar.pde

Moved all into update_soar(), and cleaned up flightmode changing