|
|
@ -12,6 +12,7 @@ from openpilot.selfdrive.controls.lib.latcontrol_pid import LatControlPID |
|
|
|
from openpilot.selfdrive.controls.lib.latcontrol_torque import LatControlTorque |
|
|
|
from openpilot.selfdrive.controls.lib.latcontrol_torque import LatControlTorque |
|
|
|
from openpilot.selfdrive.controls.lib.latcontrol_angle import LatControlAngle |
|
|
|
from openpilot.selfdrive.controls.lib.latcontrol_angle import LatControlAngle |
|
|
|
from openpilot.selfdrive.controls.lib.vehicle_model import VehicleModel |
|
|
|
from openpilot.selfdrive.controls.lib.vehicle_model import VehicleModel |
|
|
|
|
|
|
|
from selfdrive.navd.tests.test_map_renderer import gen_llk |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
class TestLatControl(unittest.TestCase): |
|
|
|
class TestLatControl(unittest.TestCase): |
|
|
@ -27,13 +28,15 @@ class TestLatControl(unittest.TestCase): |
|
|
|
|
|
|
|
|
|
|
|
CS = car.CarState.new_message() |
|
|
|
CS = car.CarState.new_message() |
|
|
|
CS.vEgo = 30 |
|
|
|
CS.vEgo = 30 |
|
|
|
|
|
|
|
CS.steeringPressed = False |
|
|
|
|
|
|
|
|
|
|
|
last_actuators = car.CarControl.Actuators.new_message() |
|
|
|
last_actuators = car.CarControl.Actuators.new_message() |
|
|
|
|
|
|
|
|
|
|
|
params = log.LiveParametersData.new_message() |
|
|
|
params = log.LiveParametersData.new_message() |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
llk = gen_llk() |
|
|
|
for _ in range(1000): |
|
|
|
for _ in range(1000): |
|
|
|
_, _, lac_log = controller.update(True, CS, CP, VM, params, last_actuators, True, 1, 0) |
|
|
|
_, _, lac_log = controller.update(True, CS, VM, params, last_actuators, False, 1, 0, llk) |
|
|
|
|
|
|
|
|
|
|
|
self.assertTrue(lac_log.saturated) |
|
|
|
self.assertTrue(lac_log.saturated) |
|
|
|
|
|
|
|
|
|
|
|