Soar: added params and fixed mode switching

Added ALT_MIN and ALT_MAX params for flight safety. Also moved mode
switching logic to set_mode() which improved soaring control logic when
modes are switched manually.  Made additional preparations for throttle
control.