|
|
|
@ -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"] |
|
|
|
|