added - avoidance functions

commands_logic - changed verify to pool the nav_mode flag
control_auto - added calls to init and update if nav_mode requires so
control_modes - added calls to attempt changes in nav_mode