Programming trick to be able to go in and out of agility mode quickly and easily, and have self leveling after doing flips