diff --git a/selfdrive/controls/lib/lateral_mpc_lib/lat_mpc.py b/selfdrive/controls/lib/lateral_mpc_lib/lat_mpc.py index 5ac9c96e7b..ee028b2e33 100755 --- a/selfdrive/controls/lib/lateral_mpc_lib/lat_mpc.py +++ b/selfdrive/controls/lib/lateral_mpc_lib/lat_mpc.py @@ -180,6 +180,8 @@ class LateralMpc(): t = sec_since_boot() self.solution_status = self.solver.solve() + if self.solution_status != 0: + raise RuntimeError(self.solution_status) self.solve_time = sec_since_boot() - t for i in range(N+1):