mavlink added, tests added, some minor modifocations
src/mavlink added