A prediction- and cost function-based algorithm for robust autonomous freeway driving | IEEE Conference Publication | IEEE Xplore