Flight mode debugged

Still trying to get consistent timing, unable to confirm if modes are
changing, but serial write do work