FF32 code adapted to Naze32 flight controller.