Fixed mavlink issues.