Autonomous driving algorithm optimization