Control Architecture and Path Planning for Quadcopters in Formation