Fix bugged exception in lst_sq_computer.

old-commit-hash: c4d89699d9
commatwo_master
George Hotz 5 years ago
parent 3e6a21d695
commit 7111bd1113
  1. 3
      selfdrive/locationd/kalman/helpers/lst_sq_computer.py

@ -109,9 +109,6 @@ class LstSqComputer():
depth = 1 / param[2] depth = 1 / param[2]
if debug: if debug:
if not self.debug:
raise NotImplementedError("This is not a debug computer")
# orient_err_jac = self.orient_error_jac(param, poses, img_positions, np.zeros(3)).reshape((-1,2,3)) # orient_err_jac = self.orient_error_jac(param, poses, img_positions, np.zeros(3)).reshape((-1,2,3))
jac = self.residual_jac(param, poses, img_positions).reshape((-1, 2, 3)) jac = self.residual_jac(param, poses, img_positions).reshape((-1, 2, 3))
res = self.residual(param, poses, img_positions).reshape((-1, 2)) res = self.residual(param, poses, img_positions).reshape((-1, 2))

Loading…
Cancel
Save