mavlink added, tests added, some minor modifocations