Most autonomous driving architectures separate planning and control phases in different layers, even though both problems are intrinsically related. Due to limitations on the available computational ...