Publish manual_sas_mode immediately, SAS modes switch order changed to more safe
More strict conditions for arm/disarm
Merge branch 'arm_safe_fix' into seatbelt_multirotor