Abstract: Safety and stability are critical requirements for autonomous driving systems. Optimization methods based on penalty functions rely on gradient and penalty parameter updates, which suffers ...