First commit of the quadcopter flight control