mirror of
https://github.com/sunnypilot/sunnypilot.git
synced 2026-09-27 15:23:52 +08:00
github-actions[bot]
0b2c431d3a
version: sunnypilot v2026.003.000 (dev)
date: 2026-09-14T15:43:39
master commit: a5f44653d7
28 lines
1.1 KiB
Python
28 lines
1.1 KiB
Python
from opendbc.car.structs import car
|
|
from openpilot.common.test import OpenpilotTestCase
|
|
from openpilot.selfdrive.locationd.torqued import TorqueEstimator
|
|
|
|
|
|
class TestTorqued(OpenpilotTestCase):
|
|
def test_cal_percent(self):
|
|
est = TorqueEstimator(car.CarParams())
|
|
msg = est.get_msg()
|
|
assert msg.lateralTorqueParameters.calPerc == 0
|
|
|
|
for (low, high), min_pts in zip(est.filtered_points.buckets.keys(),
|
|
est.filtered_points.buckets_min_points.values(), strict=True):
|
|
for _ in range(int(min_pts)):
|
|
est.filtered_points.add_point((low + high) / 2.0, 0.0)
|
|
|
|
# enough bucket points, but not enough total points
|
|
msg = est.get_msg()
|
|
assert msg.lateralTorqueParameters.calPerc == (len(est.filtered_points) / est.min_points_total * 100 + 100) / 2
|
|
|
|
# add enough points to bucket with most capacity
|
|
key = list(est.filtered_points.buckets)[0]
|
|
for _ in range(est.min_points_total - len(est.filtered_points)):
|
|
est.filtered_points.add_point((key[0] + key[1]) / 2.0, 0.0)
|
|
|
|
msg = est.get_msg()
|
|
assert msg.lateralTorqueParameters.calPerc == 100
|