pull/29442/head
Shane Smiskol 2 years ago
parent 7591763bac
commit d1cc276604
  1. 3
      selfdrive/car/hyundai/carstate.py

@ -73,8 +73,6 @@ class CarState(CarStateBase):
)
ret.vEgoRaw = (ret.wheelSpeeds.fl + ret.wheelSpeeds.fr + ret.wheelSpeeds.rl + ret.wheelSpeeds.rr) / 4.
ret.vEgo, ret.aEgo = self.update_speed_kf(ret.vEgoRaw)
# ret.standstill = ret.vEgoRaw <= 0.10416666666666667
# ret.standstill = ((ret.wheelSpeeds.fl + ret.wheelSpeeds.rr) / 2) <= STANDSTILL_THRESHOLD
ret.standstill = ret.wheelSpeeds.fl <= STANDSTILL_THRESHOLD and ret.wheelSpeeds.rr <= STANDSTILL_THRESHOLD
self.cluster_speed_counter += 1
@ -194,7 +192,6 @@ class CarState(CarStateBase):
)
ret.vEgoRaw = (ret.wheelSpeeds.fl + ret.wheelSpeeds.fr + ret.wheelSpeeds.rl + ret.wheelSpeeds.rr) / 4.
ret.vEgo, ret.aEgo = self.update_speed_kf(ret.vEgoRaw)
# ret.standstill = ret.vEgoRaw < 0.1
ret.standstill = ret.wheelSpeeds.fl <= STANDSTILL_THRESHOLD and ret.wheelSpeeds.rr <= STANDSTILL_THRESHOLD
ret.steeringRateDeg = cp.vl["STEERING_SENSORS"]["STEERING_RATE"]

Loading…
Cancel
Save