debuing code for UM6 XMEGA quadcopter