Added source code from AeroQuad