Commander attitude flag fix
Merge branch 'offboard2' into offb_sonar