fixed gyro drifting
Merge branch 'fix_bt_self_disarm' of https://github.com/SeniorDesign2014/MainFirmware