Fix brake_timeout bug and Wind_comp if !landed

Also fix some transitions between modes and now we manage everything
from command and not sensor, this avoid unstabilities.