pull/26850/head
Kurt Nistelberger 3 years ago
parent 716e8151b2
commit 238bccd251
  1. 3
      selfdrive/locationd/laikad.py

@ -98,9 +98,10 @@ class Laikad:
if len(position_solution) < 3: if len(position_solution) < 3:
return None return None
position_estimate = position_solution[:3] position_estimate = position_solution[:3]
#TODO median abs residual is decent estimate of std, can be improved with measurements stds and/or DOP
position_std = np.median(np.abs(pr_residuals)) * np.ones(3) position_std = np.median(np.abs(pr_residuals)) * np.ones(3)
velocity_solution, prr_residuals = calc_vel_fix(measurements, position_estimate, min_measurements=min_measurements) velocity_solution, prr_residuals = calc_vel_fix(measurements, position_estimate, min_measurements=min_measurements)
if len(velocity_solution) == 0 or len(prr_residuals) == 0: if len(velocity_solution) < 3:
return None return None
velocity_estimate = velocity_solution[:3] velocity_estimate = velocity_solution[:3]

Loading…
Cancel
Save