Compare commits

..

3 Commits

Author SHA1 Message Date
royjr 8d5f74b84a Update opendbc_repo 2026-08-16 15:30:31 -04:00
Jason Wen 91d0f3309c DEC: restore gate on longitudinal E2E output (#1911)
dec: restore Dynamic Experimental Control gate on longitudinal e2e output
2026-08-15 19:56:19 -04:00
Jason Wen 73fc740831 [TIZI/TICI] ui: fix developer UI crash on renamed field (#1910)
ui: fix developer UI crash on renamed lateralTorqueParameters valid field
2026-08-15 19:34:50 -04:00
14 changed files with 119 additions and 2496 deletions
-1
View File
@@ -2,6 +2,5 @@ Wen
REGIST
PullRequest
cancelled
indeces
FOF
NoO
-7
View File
@@ -21,12 +21,5 @@
</clean>
</configuration>
</target>
<target id="f2590b2b-9b93-49f9-8510-da3f3724a2ae" name="replay" defaultType="TOOL">
<configuration id="d475264f-6f4c-4092-9b4e-6773309f38b7" name="replay" toolchainName="Default">
<build type="TOOL">
<tool actionId="Tool_External Tools_uv build tools replay" />
</build>
</configuration>
</target>
</component>
</project>
-7
View File
@@ -20,11 +20,4 @@
<option name="WORKING_DIRECTORY" value="$ProjectFileDir$" />
</exec>
</tool>
<tool name="uv build tools replay" showInMainMenu="false" showInEditor="false" showInProject="false" showInSearchPopup="false" disabled="false" useConsole="true" showConsoleOnStdOut="false" showConsoleOnStdErr="false" synchronizeAfterRun="true">
<exec>
<option name="COMMAND" value="bash" />
<option name="PARAMETERS" value="-c &quot;source .venv/bin/activate &amp;&amp; scons -u -j$(nproc) tools/replay/&quot;" />
<option name="WORKING_DIRECTORY" value="$ProjectFileDir$" />
</exec>
</tool>
</toolSet>
+1 -1
View File
@@ -1,5 +1,5 @@
<component name="ProjectRunConfigurationManager">
<configuration default="false" name="Build Debug" type="CLionExternalRunConfiguration" factoryName="Application" REDIRECT_INPUT="false" ELEVATE="false" USE_EXTERNAL_CONSOLE="false" EMULATE_TERMINAL="false" WORKING_DIR="file://$ProjectFileDir$/selfdrive/ui" PASS_PARENT_ENVS_2="true" PROJECT_NAME="openpilot-special" TARGET_NAME="uv Scons Build Debug" CONFIG_NAME="uv Scons Build Debug" RUN_PATH="ui">
<configuration default="false" name="Build Debug" type="CLionExternalRunConfiguration" factoryName="Application" REDIRECT_INPUT="false" ELEVATE="false" USE_EXTERNAL_CONSOLE="false" EMULATE_TERMINAL="false" WORKING_DIR="file://$ProjectFileDir$/selfdrive/ui" PASS_PARENT_ENVS_2="true" PROJECT_NAME="sunnypilot" TARGET_NAME="uv Scons Build Debug" CONFIG_NAME="uv Scons Build Debug" RUN_PATH="ui">
<envs>
<env name="QT_DBL_CLICK_DIST" value="150" />
</envs>
-27
View File
@@ -1,27 +0,0 @@
<component name="ProjectRunConfigurationManager">
<configuration default="false" name="Debug Route Controls" type="PythonConfigurationType" factoryName="Python">
<module name="openpilot-special" />
<option name="ENV_FILES" value="" />
<option name="INTERPRETER_OPTIONS" value="" />
<option name="PARENT_ENVS" value="true" />
<envs>
<env name="PYTHONUNBUFFERED" value="1" />
<env name="FINGERPRINT" value="KIA_EV9" />
<env name="SKIP_FW_QUERY" value="1" />
</envs>
<option name="SDK_HOME" value="" />
<option name="WORKING_DIRECTORY" value="$PROJECT_DIR$/selfdrive/car" />
<option name="IS_MODULE_SDK" value="true" />
<option name="ADD_CONTENT_ROOTS" value="true" />
<option name="ADD_SOURCE_ROOTS" value="true" />
<EXTENSION ID="PythonCoverageRunConfigurationExtension" runner="coverage.py" />
<option name="SCRIPT_NAME" value="$PROJECT_DIR$/selfdrive/car/card.py" />
<option name="PARAMETERS" value="" />
<option name="SHOW_COMMAND_LINE" value="false" />
<option name="EMULATE_TERMINAL" value="true" />
<option name="MODULE_MODE" value="false" />
<option name="REDIRECT_INPUT" value="false" />
<option name="INPUT_FILE" value="" />
<method v="2" />
</configuration>
</component>
-7
View File
@@ -1,7 +0,0 @@
<component name="ProjectRunConfigurationManager">
<configuration default="false" name="Replay for controls + ui" type="Multirun" separateTabs="false" reuseTabsWithFailures="false" startOneByOne="true" markFailedProcess="true" hideSuccessProcess="false" delayTime="0.0">
<runConfiguration name="replay for controls" type="Native Application" />
<runConfiguration name="Build Debug" type="Custom Build Application" />
<method v="2" />
</configuration>
</component>
-7
View File
@@ -1,7 +0,0 @@
<component name="ProjectRunConfigurationManager">
<configuration default="false" name="replay for controls" type="CLionNativeAppRunConfigurationType" focusToolWindowBeforeRun="true" PROGRAM_PARAMS="&quot;$Prompt$&quot; --block &quot;sendcan,carState,carParams,carOutput,liveTracks,carParamsSP,carStateSP,bookmarkButton&quot;" REDIRECT_INPUT="false" ELEVATE="false" USE_EXTERNAL_CONSOLE="false" EMULATE_TERMINAL="true" WORKING_DIR="file://$ProjectFileDir$/tools/replay" PASS_PARENT_ENVS_2="true" PROJECT_NAME="openpilot-special" TARGET_NAME="replay" CONFIG_NAME="replay" version="1" RUN_PATH="replay">
<method v="2">
<option name="CLION.COMPOUND.BUILD" enabled="true" />
</method>
</configuration>
</component>
-2
View File
@@ -28,8 +28,6 @@ SP_BRANCH_MIGRATIONS = {
("tizi", "release3-staging"): "release-tizi-staging",
("mici", "release3"): "release-mici",
("mici", "release3-staging"): "release-mici-staging",
("tici", "hkg-angle-steering-2025"): "hkg-angle-steering-2025-tici",
("tici", "hkg-angle-steering-2025-prebuilt"): "hkg-angle-steering-2025-tici-prebuilt"
}
BUILD_METADATA_FILENAME = "build.json"
@@ -139,23 +139,16 @@ class LongitudinalPlanner(LongitudinalPlannerSP):
output_a_target_e2e = sm['modelV2'].action.desiredAcceleration
output_should_stop_e2e = sm['modelV2'].action.shouldStop
if self.is_e2e(sm):
output_a_target = min(output_a_target_e2e, output_a_target_mpc)
self.output_should_stop = output_should_stop_e2e or output_should_stop_mpc
if output_a_target < output_a_target_mpc:
self.mpc.source = LongitudinalPlanSource.e2e
else:
output_a_target = output_a_target_mpc
self.output_should_stop = output_should_stop_mpc
is_e2e = self.is_e2e(sm)
self.a_cruise = get_cruise_accel(sm['selfdriveState'].experimentalMode, v_cruise, v_ego,
self.a_cruise = get_cruise_accel(is_e2e, v_cruise, v_ego,
self.a_cruise, steer_angle_without_offset, self.CP, self.dt,
accel_coast, self.allow_throttle)
cruise_should_stop = should_stop(v_ego, self.a_cruise)
candidates = [(output_a_target_mpc, self.mpc.source, output_should_stop_mpc),
(self.a_cruise, LongitudinalPlanSource.cruise, cruise_should_stop)]
if sm['selfdriveState'].experimentalMode:
if is_e2e:
candidates.append((output_a_target_e2e, LongitudinalPlanSource.e2e, output_should_stop_e2e))
output_a_target, self.mpc.source, _ = min(candidates, key=lambda c: c[0])
@@ -252,7 +252,7 @@ class FrictionCoefficientElement:
ltp = sm['lateralTorqueParameters']
value = f"{ltp.frictionCoefficientFiltered:.3f}"
color = rl.Color(0, 255, 0, 255) if ltp.liveValid else rl.WHITE
color = rl.Color(0, 255, 0, 255) if ltp.valid else rl.WHITE
return UiElement(value, "FRIC.", self.unit, color)
@@ -266,7 +266,7 @@ class LatAccelFactorElement:
ltp = sm['lateralTorqueParameters']
value = f"{ltp.latAccelFactorFiltered:.3f}"
color = rl.Color(0, 255, 0, 255) if ltp.liveValid else rl.WHITE
color = rl.Color(0, 255, 0, 255) if ltp.valid else rl.WHITE
return UiElement(value, "L.A.F.", self.unit, color)
@@ -0,0 +1,112 @@
"""
Copyright (c) 2021-, Haibin Wen, sunnypilot, and a number of other contributors.
This file is part of sunnypilot and is licensed under the MIT License.
See the LICENSE.md file in the root directory for more details.
"""
from typing import cast
from openpilot.cereal import custom, messaging
from opendbc.car import structs
from openpilot.common.test import OpenpilotTestCase
from openpilot.selfdrive.controls.lib.longitudinal_planner import LongitudinalPlanner, LongitudinalPlanSource
from openpilot.sunnypilot.selfdrive.controls.lib.dec.dec import DynamicExperimentalController
V_EGO = 20.0
E2E_ACCEL = -3.0 # low enough that e2e wins the min() whenever it is a candidate
class MockDec:
def __init__(self, active: bool, mode: str):
self._active = active
self._mode = mode
def update(self, sm):
pass
def active(self) -> bool:
return self._active
def mode(self) -> str:
return self._mode
def enabled(self) -> bool:
return True
class MockSubMaster(dict):
def __init__(self, services: dict):
super().__init__(services)
self.valid = dict.fromkeys(services, True)
self.logMonoTime = dict.fromkeys(services, 0)
self.updated = dict.fromkeys(services, True)
self.recv_frame = dict.fromkeys(services, 1)
def all_checks(self, service_list=None) -> bool:
return True
def build_sm(experimental_mode: bool) -> MockSubMaster:
services = {}
for service in ("radarState", "controlsState", "vehicleParameters", "carStateSP",
"liveMapDataSP", "gpsLocationExternal", "gpsLocation"):
services[service] = getattr(messaging.new_message(service), service)
car_state = messaging.new_message('carState')
car_state.carState.vEgo = V_EGO
car_state.carState.vCruise = 100.0
car_state.carState.vCruiseCluster = 100.0
services['carState'] = car_state.carState.as_reader()
selfdrive_state = messaging.new_message('selfdriveState')
selfdrive_state.selfdriveState.experimentalMode = experimental_mode
selfdrive_state.selfdriveState.enabled = True
services['selfdriveState'] = selfdrive_state.selfdriveState.as_reader()
car_control = messaging.new_message('carControl')
car_control.carControl.enabled = True
services['carControl'] = car_control.carControl.as_reader()
model = messaging.new_message('modelV2')
model.modelV2.orientationRate.z = [0.01] * 33 # nonzero: a straight path divides by zero in SCC vision
model.modelV2.velocity.x = [V_EGO] * 33
model.modelV2.position.x = [float(i) for i in range(33)]
model.modelV2.action.desiredAcceleration = E2E_ACCEL
services['modelV2'] = model.modelV2.as_reader()
return MockSubMaster(services)
def build_planner(dec_active: bool, dec_mode: str) -> LongitudinalPlanner:
CP = structs.CarParams()
CP.steerRatio = 15.0
CP.wheelbase = 2.7
CP.longitudinalActuatorDelay = 0.2
CP_SP = custom.CarParamsSP.new_message().as_reader()
planner = LongitudinalPlanner(CP, CP_SP, init_v=V_EGO)
planner.dec = cast(DynamicExperimentalController, MockDec(dec_active, dec_mode))
return planner
class TestDecPlannerGate(OpenpilotTestCase):
"""The e2e candidate must be gated on is_e2e(), not raw experimentalMode."""
def _source(self, experimental_mode: bool, dec_active: bool, dec_mode: str) -> LongitudinalPlanSource:
planner = build_planner(dec_active, dec_mode)
planner.update(build_sm(experimental_mode))
return planner.mpc.source
def test_no_e2e_when_experimental_mode_off(self):
assert self._source(False, False, 'acc') != LongitudinalPlanSource.e2e
def test_e2e_when_dec_inactive(self):
# DEC off: behavior must match upstream
assert self._source(True, False, 'acc') == LongitudinalPlanSource.e2e
def test_e2e_when_dec_blended(self):
assert self._source(True, True, 'blended') == LongitudinalPlanSource.e2e
def test_no_e2e_when_dec_holds_acc(self):
# the regression
assert self._source(True, True, 'acc') != LongitudinalPlanSource.e2e
File diff suppressed because it is too large Load Diff
File diff suppressed because one or more lines are too long