Add TestQuadCopterController