Xmega c code for quadcopter mother board