crash_safety Quantify the safety of trajectories by the peak-minimizing optimal control cost needed to crash into the unsafe set