Arduino program for the Tricopter