添加无线模块
This commit is contained in:
@@ -53,6 +53,9 @@ from cognitive_agent.application.model_plan_adapter import ( # noqa: E402
|
||||
SEAT_CAPABILITIES,
|
||||
SEAT_MOTION_CAPABILITIES,
|
||||
)
|
||||
from cognitive_agent.application.mqtt_ota_seat_executor import ( # noqa: E402
|
||||
MqttOtaSeatExecutor,
|
||||
)
|
||||
from cognitive_agent.application.native_can_intent import merge_native_can_intent # noqa: E402
|
||||
from cognitive_agent.application.native_can_relative import ( # noqa: E402
|
||||
NativeCanRelativeResolver,
|
||||
@@ -76,6 +79,12 @@ from cognitive_agent.application.vehicle_profile import ( # noqa: E402
|
||||
VehicleProfile,
|
||||
VehicleProfileRegistry,
|
||||
)
|
||||
from cognitive_agent.application.vehicle_state_monitor import ( # noqa: E402
|
||||
OBSERVABLE_IDS,
|
||||
REQUIRED_BODY_IDS,
|
||||
REQUIRED_SEAT_IDS,
|
||||
VehicleStateMonitor,
|
||||
)
|
||||
from cognitive_agent.application.zcan_seat_executor import ( # noqa: E402
|
||||
ZcanBridgeSeatExecutor,
|
||||
)
|
||||
@@ -89,8 +98,12 @@ from cognitive_agent.infrastructure.can.hardware import ( # noqa: E402
|
||||
PHYSICAL_BENCH_COORDINATOR,
|
||||
SeatHardwareSettings,
|
||||
VehicleCanSettings,
|
||||
VehicleMqttSettings,
|
||||
)
|
||||
from cognitive_agent.infrastructure.can.gateway import ZlgChannelConfig # noqa: E402
|
||||
from cognitive_agent.infrastructure.can.mqtt_transport import ( # noqa: E402
|
||||
MqttCanTransport,
|
||||
)
|
||||
from cognitive_agent.infrastructure.can.access import ( # noqa: E402
|
||||
PHYSICAL_BENCH_ACCESS,
|
||||
)
|
||||
@@ -117,6 +130,11 @@ PASSENGER_SEAT_SCOPE_PATTERN = re.compile(
|
||||
r"\bpassenger\b|\bfront[-_ ]?right\b|\bright[-_ ]?front\b|副驾|乘客|右前",
|
||||
re.IGNORECASE,
|
||||
)
|
||||
WIRED_CAN_TRANSPORT = "wired_can"
|
||||
WIRELESS_MQTT_TRANSPORT = "wireless_mqtt"
|
||||
VEHICLE_CONTROL_TRANSPORTS = frozenset(
|
||||
{WIRED_CAN_TRANSPORT, WIRELESS_MQTT_TRANSPORT}
|
||||
)
|
||||
|
||||
|
||||
def _has_mixed_driver_passenger_seat_scope(utterance: str) -> bool:
|
||||
@@ -209,6 +227,17 @@ class SeatDemoService:
|
||||
)
|
||||
self.hardware_settings = SeatHardwareSettings.from_env(repository_root)
|
||||
self.vehicle_can_settings = VehicleCanSettings.from_env(repository_root)
|
||||
self.vehicle_mqtt_settings = VehicleMqttSettings.from_env()
|
||||
self._vehicle_state_monitor = (
|
||||
VehicleStateMonitor(self.vehicle_can_settings)
|
||||
if self.vehicle_can_settings.backend == "zlgcan-linux"
|
||||
and self.vehicle_can_settings.state_configured
|
||||
and not self.vehicle_can_settings.configured
|
||||
else None
|
||||
)
|
||||
self._vehicle_mqtt_transport = MqttCanTransport(
|
||||
self.vehicle_mqtt_settings
|
||||
)
|
||||
self.native_can_runtime = NativeCanRuntime(repository_root)
|
||||
self.native_can_relative_resolver = NativeCanRelativeResolver(repository_root)
|
||||
self.hardware_execution = PHYSICAL_BENCH_COORDINATOR
|
||||
@@ -272,6 +301,22 @@ class SeatDemoService:
|
||||
and self.vehicle_can_settings.channel == 1
|
||||
)
|
||||
|
||||
def _driver_only_vehicle_execution_active(self, transport: str) -> bool:
|
||||
if self.hardware_settings.enabled:
|
||||
return False
|
||||
if transport == WIRELESS_MQTT_TRANSPORT:
|
||||
return self.vehicle_mqtt_settings.configured
|
||||
return self.driver_only_ch1_execution_active
|
||||
|
||||
@staticmethod
|
||||
def _validate_control_transport(transport: str) -> str:
|
||||
normalized = str(transport).strip().lower()
|
||||
if normalized not in VEHICLE_CONTROL_TRANSPORTS:
|
||||
raise ValueError(
|
||||
"control_transport must be wired_can or wireless_mqtt"
|
||||
)
|
||||
return normalized
|
||||
|
||||
def runtime_info(self) -> dict[str, Any]:
|
||||
catalog = yaml.safe_load(
|
||||
(self.domain_root / "config" / "capabilities.yaml").read_text(encoding="utf-8")
|
||||
@@ -283,6 +328,15 @@ class SeatDemoService:
|
||||
hardware_info = self.hardware_settings.public_info()
|
||||
hardware_info.update(self.hardware_execution.public_info())
|
||||
hardware_info.update(self.hardware_access.public_info())
|
||||
vehicle_can_info = self.vehicle_can_settings.public_info()
|
||||
if self._vehicle_state_monitor is not None:
|
||||
state_sync_info = self._vehicle_state_monitor.public_info()
|
||||
if self.hardware_settings.configured:
|
||||
# Keep the slower legacy cadence when the same page also polls
|
||||
# the physical passenger-seat path through the shared adapter.
|
||||
state_sync_info["poll_interval_ms"] = 5_000
|
||||
vehicle_can_info["state_sync"] = state_sync_info
|
||||
vehicle_mqtt_info = self._vehicle_mqtt_transport.public_info()
|
||||
return {
|
||||
"service": "cabin-cognitive-orchestrator",
|
||||
"domain": "cabin",
|
||||
@@ -294,9 +348,27 @@ class SeatDemoService:
|
||||
"hardware_execution_allowed": (
|
||||
self.hardware_settings.configured
|
||||
or self.vehicle_can_settings.configured
|
||||
or self.vehicle_mqtt_settings.configured
|
||||
),
|
||||
"hardware": hardware_info,
|
||||
"vehicle_can": self.vehicle_can_settings.public_info(),
|
||||
"vehicle_can": vehicle_can_info,
|
||||
"vehicle_mqtt": vehicle_mqtt_info,
|
||||
"vehicle_transports": {
|
||||
"default": WIRED_CAN_TRANSPORT,
|
||||
"selection_scope": "browser_request",
|
||||
"options": [
|
||||
{
|
||||
"id": WIRED_CAN_TRANSPORT,
|
||||
"label": "有线控制",
|
||||
**vehicle_can_info,
|
||||
},
|
||||
{
|
||||
"id": WIRELESS_MQTT_TRANSPORT,
|
||||
"label": "无线控制",
|
||||
**vehicle_mqtt_info,
|
||||
},
|
||||
],
|
||||
},
|
||||
"vehicle_safety_policy": {
|
||||
"required_channel": 1,
|
||||
"required_gear": "P",
|
||||
@@ -322,6 +394,8 @@ class SeatDemoService:
|
||||
and self.vehicle_can_settings.configured
|
||||
else "ch1_body_can_driver_only"
|
||||
if self.vehicle_can_settings.configured
|
||||
else "ch1_body_can_read_only"
|
||||
if self.vehicle_can_settings.state_configured
|
||||
else "ch0_passenger_only"
|
||||
if self.hardware_settings.configured
|
||||
else "virtual_only"
|
||||
@@ -407,23 +481,54 @@ class SeatDemoService:
|
||||
conversation_id: str,
|
||||
vehicle_id: str | None = None,
|
||||
*,
|
||||
control_transport: str = WIRED_CAN_TRANSPORT,
|
||||
hardware_client_id: str | None = None,
|
||||
hardware_access_bypass: bool = True,
|
||||
) -> dict[str, Any]:
|
||||
"""Read the bench only when no physical execution currently owns it."""
|
||||
|
||||
control_transport = self._validate_control_transport(control_transport)
|
||||
mqtt_selected = control_transport == WIRELESS_MQTT_TRANSPORT
|
||||
if hardware_access_bypass:
|
||||
# Wireless CAN0 is a thread-safe view over the persistent MQTT
|
||||
# subscription. HardwareSeatExecutor still serializes this seat
|
||||
# read with seat actuation through its adapter lock, while an
|
||||
# absent CAN0 stream must not block the independent cached CAN1
|
||||
# dashboard or make control requests fail with hardware_busy.
|
||||
if mqtt_selected:
|
||||
return self._synchronize_hardware_state_once(
|
||||
conversation_id,
|
||||
vehicle_id,
|
||||
control_transport=control_transport,
|
||||
)
|
||||
with self.hardware_execution.reserve():
|
||||
return self._synchronize_hardware_state_once(conversation_id, vehicle_id)
|
||||
return self._synchronize_hardware_state_once(
|
||||
conversation_id,
|
||||
vehicle_id,
|
||||
control_transport=control_transport,
|
||||
)
|
||||
authorized_client_id = self.hardware_access.ensure_authorized(hardware_client_id)
|
||||
if mqtt_selected:
|
||||
with self.hardware_access.use(authorized_client_id):
|
||||
return self._synchronize_hardware_state_once(
|
||||
conversation_id,
|
||||
vehicle_id,
|
||||
control_transport=control_transport,
|
||||
)
|
||||
with self.hardware_execution.reserve():
|
||||
with self.hardware_access.use(authorized_client_id):
|
||||
return self._synchronize_hardware_state_once(conversation_id, vehicle_id)
|
||||
return self._synchronize_hardware_state_once(
|
||||
conversation_id,
|
||||
vehicle_id,
|
||||
control_transport=control_transport,
|
||||
)
|
||||
|
||||
def _synchronize_hardware_state_once(
|
||||
self,
|
||||
conversation_id: str,
|
||||
vehicle_id: str | None = None,
|
||||
*,
|
||||
control_transport: str = WIRED_CAN_TRANSPORT,
|
||||
) -> dict[str, Any]:
|
||||
"""Read the bench and project it into the current passenger conversation."""
|
||||
|
||||
@@ -431,10 +536,26 @@ class SeatDemoService:
|
||||
raise ValueError(
|
||||
"conversation_id must start with conv- and contain only lowercase letters, numbers, or hyphens"
|
||||
)
|
||||
if not self.hardware_settings.configured:
|
||||
raise HardwareSafetyError("the T2G seat hardware runtime is not configured")
|
||||
control_transport = self._validate_control_transport(control_transport)
|
||||
mqtt_selected = control_transport == WIRELESS_MQTT_TRANSPORT
|
||||
if mqtt_selected:
|
||||
if not self.vehicle_mqtt_settings.state_configured:
|
||||
raise HardwareSafetyError("the MQTT CAN0 seat relay is not configured")
|
||||
bus_factory = lambda: self._vehicle_mqtt_transport.bus(
|
||||
channel=0,
|
||||
replay_latest=True,
|
||||
)
|
||||
else:
|
||||
if not self.hardware_settings.configured:
|
||||
raise HardwareSafetyError("the T2G seat hardware runtime is not configured")
|
||||
bus_factory = None
|
||||
vehicle_profile = self.vehicle_profiles.get(vehicle_id)
|
||||
physical_state = self._new_hardware_executor().read_physical_state()
|
||||
physical_state = self._new_hardware_executor(
|
||||
bus_factory,
|
||||
remote_transport=mqtt_selected,
|
||||
).read_physical_state()
|
||||
if mqtt_selected:
|
||||
physical_state["source"] = "wireless_mqtt_ch0"
|
||||
context = self.conversations.synchronize_physical_passenger(
|
||||
conversation_id,
|
||||
physical_state,
|
||||
@@ -444,7 +565,8 @@ class SeatDemoService:
|
||||
"status": "succeeded",
|
||||
"conversation_id": conversation_id,
|
||||
"conversation_turn": context["turn_count"],
|
||||
"source": "physical_can",
|
||||
"source": "wireless_mqtt_ch0" if mqtt_selected else "physical_can",
|
||||
"control_transport": control_transport,
|
||||
"captured_at": physical_state.get("captured_at"),
|
||||
"complete": bool(physical_state.get("complete")),
|
||||
"missing": list(physical_state.get("missing", [])),
|
||||
@@ -457,38 +579,103 @@ class SeatDemoService:
|
||||
conversation_id: str,
|
||||
vehicle_id: str | None = None,
|
||||
*,
|
||||
control_transport: str = WIRED_CAN_TRANSPORT,
|
||||
hardware_client_id: str | None = None,
|
||||
hardware_access_bypass: bool = True,
|
||||
) -> dict[str, Any]:
|
||||
"""Passively receive CH1 driver-seat feedback without transmitting CAN."""
|
||||
|
||||
control_transport = self._validate_control_transport(control_transport)
|
||||
mqtt_selected = control_transport == WIRELESS_MQTT_TRANSPORT
|
||||
|
||||
if hardware_access_bypass:
|
||||
# The MQTT snapshot is already decoded and protected by the
|
||||
# transport condition lock. It is independent from physical
|
||||
# execution ownership and should remain readable during CAN0
|
||||
# waits or an in-flight command.
|
||||
if mqtt_selected:
|
||||
return self._synchronize_vehicle_state_once(
|
||||
conversation_id,
|
||||
vehicle_id,
|
||||
control_transport=control_transport,
|
||||
)
|
||||
with self.hardware_execution.reserve():
|
||||
return self._synchronize_vehicle_state_once(conversation_id, vehicle_id)
|
||||
return self._synchronize_vehicle_state_once(
|
||||
conversation_id,
|
||||
vehicle_id,
|
||||
control_transport=control_transport,
|
||||
)
|
||||
authorized_client_id = self.hardware_access.ensure_authorized(hardware_client_id)
|
||||
if mqtt_selected:
|
||||
with self.hardware_access.use(authorized_client_id):
|
||||
return self._synchronize_vehicle_state_once(
|
||||
conversation_id,
|
||||
vehicle_id,
|
||||
control_transport=control_transport,
|
||||
)
|
||||
with self.hardware_execution.reserve():
|
||||
with self.hardware_access.use(authorized_client_id):
|
||||
return self._synchronize_vehicle_state_once(conversation_id, vehicle_id)
|
||||
return self._synchronize_vehicle_state_once(
|
||||
conversation_id,
|
||||
vehicle_id,
|
||||
control_transport=control_transport,
|
||||
)
|
||||
|
||||
def start(self) -> None:
|
||||
if self._vehicle_state_monitor is not None:
|
||||
self._vehicle_state_monitor.start()
|
||||
self._vehicle_mqtt_transport.start()
|
||||
|
||||
def close(self) -> None:
|
||||
if self._vehicle_state_monitor is not None:
|
||||
self._vehicle_state_monitor.close()
|
||||
self._vehicle_mqtt_transport.close()
|
||||
|
||||
def _synchronize_vehicle_state_once(
|
||||
self,
|
||||
conversation_id: str,
|
||||
vehicle_id: str | None = None,
|
||||
*,
|
||||
control_transport: str = WIRED_CAN_TRANSPORT,
|
||||
) -> dict[str, Any]:
|
||||
if not CONVERSATION_ID_PATTERN.fullmatch(conversation_id):
|
||||
raise ValueError(
|
||||
"conversation_id must start with conv- and contain only lowercase letters, numbers, or hyphens"
|
||||
)
|
||||
if not self.vehicle_can_settings.configured:
|
||||
control_transport = self._validate_control_transport(control_transport)
|
||||
mqtt_selected = control_transport == WIRELESS_MQTT_TRANSPORT
|
||||
if mqtt_selected:
|
||||
if not self.vehicle_mqtt_settings.state_configured:
|
||||
raise HardwareSafetyError("the MQTT vehicle CAN relay is not configured")
|
||||
elif not self.vehicle_can_settings.state_configured:
|
||||
raise HardwareSafetyError("the CH1 vehicle CAN runtime is not configured")
|
||||
|
||||
vehicle_profile = self.vehicle_profiles.get(vehicle_id)
|
||||
shared_runtime_enabled = os.getenv(
|
||||
"COGNITIVE_AGENT_SHARED_CAN_RUNTIME_ENABLED",
|
||||
os.getenv("COGNITIVE_AGENT_SEAT_SHARED_ZCANPRO_BRIDGE_ENABLED", "true"),
|
||||
).strip().lower() in {"1", "true", "yes", "on"}
|
||||
shared_runtime_enabled = (
|
||||
self.vehicle_can_settings.backend != "zlgcan-linux"
|
||||
and self.vehicle_can_settings.configured
|
||||
and os.getenv(
|
||||
"COGNITIVE_AGENT_SHARED_CAN_RUNTIME_ENABLED",
|
||||
os.getenv(
|
||||
"COGNITIVE_AGENT_SEAT_SHARED_ZCANPRO_BRIDGE_ENABLED", "true"
|
||||
),
|
||||
).strip().lower() in {"1", "true", "yes", "on"}
|
||||
)
|
||||
bridge = None
|
||||
if shared_runtime_enabled:
|
||||
capture_sequence: int | None = None
|
||||
if mqtt_selected:
|
||||
snapshot = self._vehicle_mqtt_transport.snapshot()
|
||||
feedback_states = list(snapshot.feedback_states)
|
||||
observed_ids = set(snapshot.observed_ids)
|
||||
captured_at = snapshot.captured_at
|
||||
capture_sequence = snapshot.capture_sequence
|
||||
elif self._vehicle_state_monitor is not None:
|
||||
snapshot = self._vehicle_state_monitor.snapshot()
|
||||
feedback_states = list(snapshot.feedback_states)
|
||||
observed_ids = set(snapshot.observed_ids)
|
||||
captured_at = snapshot.captured_at
|
||||
capture_sequence = snapshot.capture_sequence
|
||||
elif shared_runtime_enabled:
|
||||
from cognitive_agent.application.self_repair.service import BRIDGE_MANAGER
|
||||
|
||||
if not hasattr(BRIDGE_MANAGER, "channel_bus_factory"):
|
||||
@@ -500,68 +687,65 @@ class SeatDemoService:
|
||||
)()
|
||||
else:
|
||||
bridge = self.vehicle_can_settings.bridge(
|
||||
[self.vehicle_can_settings.channel_config()]
|
||||
[self.vehicle_can_settings.channel_config()],
|
||||
monitor_only=True,
|
||||
)
|
||||
bus = bridge.channel_bus(self.vehicle_can_settings.channel)
|
||||
|
||||
feedback_states: list[dict[str, Any]] = []
|
||||
observed_ids: set[int] = set()
|
||||
# Keep driver-seat completeness compatible with the existing endpoint,
|
||||
# while passively collecting every recognized CH1 body-state frame for
|
||||
# the whole-vehicle dashboard during the same bounded receive window.
|
||||
required_seat_ids = {0x4FA, 0x494}
|
||||
required_body_ids = {0x342, 0x4EB, 0x407}
|
||||
observable_ids = {
|
||||
*required_seat_ids,
|
||||
*required_body_ids,
|
||||
0x388,
|
||||
0x404,
|
||||
0x41A,
|
||||
0x42E,
|
||||
}
|
||||
deadline = time.monotonic() + self.vehicle_can_settings.feedback_timeout_ms / 1000
|
||||
try:
|
||||
while time.monotonic() < deadline and observed_ids != observable_ids:
|
||||
remaining_ms = max(1, int((deadline - time.monotonic()) * 1000))
|
||||
frame = bus.receive(remaining_ms, include_fd=True)
|
||||
if frame is None:
|
||||
break
|
||||
if frame.channel != self.vehicle_can_settings.channel:
|
||||
continue
|
||||
if frame.arbitration_id not in observable_ids or len(frame.data) < 8:
|
||||
continue
|
||||
decoded = decode_feedback(frame)
|
||||
if not any(
|
||||
key in decoded
|
||||
for key in ("actuator_state", "domain_state", "vehicle_safety")
|
||||
):
|
||||
# 0x4EB is multiplexed. Only subtype 0x07 carries the
|
||||
# verified speed signal, so unrelated subframes must not
|
||||
# make the body-state snapshot look complete.
|
||||
continue
|
||||
frame_id = str(decoded.get("frame_id", ""))
|
||||
decoded.update(
|
||||
{
|
||||
"valid": True,
|
||||
"feedback_frame_id": frame_id,
|
||||
"captured_at": _now(),
|
||||
"verification": {
|
||||
"authoritative": True,
|
||||
"channel": 1,
|
||||
"simulated": False,
|
||||
"read_only": True,
|
||||
"frame_id": frame_id,
|
||||
"payload_size": len(frame.data),
|
||||
},
|
||||
}
|
||||
)
|
||||
feedback_states.append(decoded)
|
||||
observed_ids.add(frame.arbitration_id)
|
||||
finally:
|
||||
if bridge is not None:
|
||||
bridge.close()
|
||||
else:
|
||||
bus.close()
|
||||
if not mqtt_selected and self._vehicle_state_monitor is None:
|
||||
feedback_states = []
|
||||
observed_ids = set()
|
||||
captured_at = None
|
||||
# Keep driver-seat completeness compatible with the existing endpoint,
|
||||
# while passively collecting every recognized CH1 body-state frame for
|
||||
# the whole-vehicle dashboard during the same bounded receive window.
|
||||
deadline = (
|
||||
time.monotonic()
|
||||
+ self.vehicle_can_settings.feedback_timeout_ms / 1000
|
||||
)
|
||||
try:
|
||||
while time.monotonic() < deadline and observed_ids != OBSERVABLE_IDS:
|
||||
remaining_ms = max(1, int((deadline - time.monotonic()) * 1000))
|
||||
frame = bus.receive(remaining_ms, include_fd=True)
|
||||
if frame is None:
|
||||
break
|
||||
if frame.channel != self.vehicle_can_settings.channel:
|
||||
continue
|
||||
if frame.arbitration_id not in OBSERVABLE_IDS or len(frame.data) < 8:
|
||||
continue
|
||||
decoded = decode_feedback(frame)
|
||||
if not any(
|
||||
key in decoded
|
||||
for key in ("actuator_state", "domain_state", "vehicle_safety")
|
||||
):
|
||||
# 0x4EB is multiplexed. Only subtype 0x07 carries the
|
||||
# verified speed signal, so unrelated subframes must not
|
||||
# make the body-state snapshot look complete.
|
||||
continue
|
||||
frame_id = str(decoded.get("frame_id", ""))
|
||||
decoded.update(
|
||||
{
|
||||
"valid": True,
|
||||
"feedback_frame_id": frame_id,
|
||||
"captured_at": _now(),
|
||||
"verification": {
|
||||
"authoritative": True,
|
||||
"channel": 1,
|
||||
"simulated": False,
|
||||
"read_only": True,
|
||||
"frame_id": frame_id,
|
||||
"payload_size": len(frame.data),
|
||||
},
|
||||
}
|
||||
)
|
||||
feedback_states.append(decoded)
|
||||
observed_ids.add(frame.arbitration_id)
|
||||
captured_at = str(decoded["captured_at"])
|
||||
finally:
|
||||
if bridge is not None:
|
||||
bridge.close()
|
||||
else:
|
||||
bus.close()
|
||||
|
||||
context = self.conversations.synchronize_physical_ch1_feedback(
|
||||
conversation_id,
|
||||
@@ -570,19 +754,23 @@ class SeatDemoService:
|
||||
context = self._context_for_vehicle(context, vehicle_profile)
|
||||
missing = [
|
||||
f"0x{frame_id:03X}"
|
||||
for frame_id in sorted(required_seat_ids - observed_ids)
|
||||
for frame_id in sorted(REQUIRED_SEAT_IDS - observed_ids)
|
||||
]
|
||||
body_state_missing = [
|
||||
f"0x{frame_id:03X}"
|
||||
for frame_id in sorted(required_body_ids - observed_ids)
|
||||
for frame_id in sorted(REQUIRED_BODY_IDS - observed_ids)
|
||||
]
|
||||
return {
|
||||
"status": "succeeded",
|
||||
"conversation_id": conversation_id,
|
||||
"conversation_turn": context["turn_count"],
|
||||
"source": "physical_can_ch1",
|
||||
"source": (
|
||||
"wireless_mqtt_ch1" if mqtt_selected else "physical_can_ch1"
|
||||
),
|
||||
"control_transport": control_transport,
|
||||
"read_only": True,
|
||||
"captured_at": feedback_states[-1].get("captured_at") if feedback_states else _now(),
|
||||
"captured_at": captured_at or _now(),
|
||||
"capture_sequence": capture_sequence,
|
||||
"complete": not missing,
|
||||
"missing": missing,
|
||||
"body_state_complete": not body_state_missing,
|
||||
@@ -593,8 +781,11 @@ class SeatDemoService:
|
||||
}
|
||||
|
||||
def _new_hardware_executor(
|
||||
self, bus_factory: Any | None = None
|
||||
) -> HardwareSeatExecutor:
|
||||
self,
|
||||
bus_factory: Any | None = None,
|
||||
*,
|
||||
remote_transport: bool = False,
|
||||
) -> HardwareSeatExecutor | MqttOtaSeatExecutor | ZcanBridgeSeatExecutor:
|
||||
shared_bridge_enabled = os.getenv(
|
||||
"COGNITIVE_AGENT_SHARED_CAN_RUNTIME_ENABLED",
|
||||
os.getenv("COGNITIVE_AGENT_SEAT_SHARED_ZCANPRO_BRIDGE_ENABLED", "true"),
|
||||
@@ -624,7 +815,7 @@ class SeatDemoService:
|
||||
auto_home=self.hardware_settings.auto_home_enabled,
|
||||
)
|
||||
resolved_bus_factory = bus_factory or self.hardware_settings.bus_factory()
|
||||
return HardwareSeatExecutor(
|
||||
executor = HardwareSeatExecutor(
|
||||
self.hardware_matrix,
|
||||
resolved_bus_factory,
|
||||
thermal_timeout_ms=self.hardware_settings.thermal_timeout_ms,
|
||||
@@ -644,12 +835,19 @@ class SeatDemoService:
|
||||
),
|
||||
auto_home=self.hardware_settings.auto_home_enabled,
|
||||
home_timeout_s=self.hardware_settings.home_timeout_s,
|
||||
firmware_guard=self.hardware_settings.firmware_guard(resolved_bus_factory),
|
||||
firmware_guard=self.hardware_settings.firmware_guard(
|
||||
resolved_bus_factory,
|
||||
allow_programming=not remote_transport,
|
||||
),
|
||||
synchronize_position_before_first_motion=(
|
||||
self.hardware_settings.position_sync_enabled
|
||||
),
|
||||
position_sync_state=self._seat_position_memory_state,
|
||||
require_thermal_feedback=not remote_transport,
|
||||
)
|
||||
if remote_transport:
|
||||
return MqttOtaSeatExecutor(executor, resolved_bus_factory)
|
||||
return executor
|
||||
|
||||
def process(
|
||||
self,
|
||||
@@ -664,7 +862,9 @@ class SeatDemoService:
|
||||
hardware_client_id: str | None = None,
|
||||
hardware_access_bypass: bool = True,
|
||||
reasoning_effort: str | None = None,
|
||||
control_transport: str = WIRED_CAN_TRANSPORT,
|
||||
) -> dict[str, Any]:
|
||||
control_transport = self._validate_control_transport(control_transport)
|
||||
# Creating a reusable scene is a configuration workflow. Synthesize
|
||||
# and validate it in dry-run even when the console currently targets
|
||||
# the real bench, otherwise virtual domains such as climate or ambient
|
||||
@@ -681,8 +881,11 @@ class SeatDemoService:
|
||||
vehicle_id,
|
||||
simulation_fault,
|
||||
reasoning_effort,
|
||||
control_transport,
|
||||
)
|
||||
if hardware_access_bypass or self.driver_only_ch1_execution_active:
|
||||
if hardware_access_bypass or self._driver_only_vehicle_execution_active(
|
||||
control_transport
|
||||
):
|
||||
with self.hardware_execution.reserve():
|
||||
return self._process_once(
|
||||
utterance,
|
||||
@@ -693,6 +896,7 @@ class SeatDemoService:
|
||||
vehicle_id,
|
||||
simulation_fault,
|
||||
reasoning_effort,
|
||||
control_transport,
|
||||
)
|
||||
authorized_client_id = self.hardware_access.ensure_authorized(hardware_client_id)
|
||||
with self.hardware_execution.reserve():
|
||||
@@ -706,6 +910,7 @@ class SeatDemoService:
|
||||
vehicle_id,
|
||||
simulation_fault,
|
||||
reasoning_effort,
|
||||
control_transport,
|
||||
)
|
||||
|
||||
def _process_once(
|
||||
@@ -718,7 +923,9 @@ class SeatDemoService:
|
||||
vehicle_id: str | None = None,
|
||||
simulation_fault: str = "normal",
|
||||
reasoning_effort: str | None = None,
|
||||
control_transport: str = WIRED_CAN_TRANSPORT,
|
||||
) -> dict[str, Any]:
|
||||
control_transport = self._validate_control_transport(control_transport)
|
||||
utterance = utterance.strip()
|
||||
if not utterance:
|
||||
raise ValueError("utterance must not be empty")
|
||||
@@ -776,6 +983,7 @@ class SeatDemoService:
|
||||
vehicle_profile,
|
||||
simulation_fault,
|
||||
mode_create_name,
|
||||
control_transport,
|
||||
)
|
||||
|
||||
request_id = f"req-{datetime.now(UTC).strftime('%Y%m%d%H%M%S')}-{uuid.uuid4().hex[:6]}"
|
||||
@@ -798,6 +1006,7 @@ class SeatDemoService:
|
||||
"reasoning_effort_requested": effective_reasoning_effort,
|
||||
"reasoning_effort_used": None,
|
||||
"execution_mode": execution_mode,
|
||||
"control_transport": control_transport,
|
||||
"hardware_execution_allowed": (
|
||||
hardware_request and not control_plane_request
|
||||
),
|
||||
@@ -899,7 +1108,14 @@ class SeatDemoService:
|
||||
parsed = apply_language_safety_guards(parsed, utterance)
|
||||
parsed = self._partition_native_actions(
|
||||
parsed,
|
||||
promote_supported=(hardware_request and self.vehicle_can_settings.enabled),
|
||||
promote_supported=(
|
||||
hardware_request
|
||||
and (
|
||||
self.vehicle_mqtt_settings.enabled
|
||||
if control_transport == WIRELESS_MQTT_TRANSPORT
|
||||
else self.vehicle_can_settings.enabled
|
||||
)
|
||||
),
|
||||
)
|
||||
if hardware_request and not control_plane_request:
|
||||
if parsed.get("domain_actions"):
|
||||
@@ -914,28 +1130,40 @@ class SeatDemoService:
|
||||
+ ", ".join(unsupported)
|
||||
)
|
||||
if parsed.get("actions"):
|
||||
self.hardware_settings.authorize(approval_token)
|
||||
(
|
||||
self.vehicle_mqtt_settings
|
||||
if control_transport == WIRELESS_MQTT_TRANSPORT
|
||||
else self.hardware_settings
|
||||
).authorize(approval_token)
|
||||
if parsed.get("native_can_actions"):
|
||||
self.vehicle_can_settings.authorize(approval_token)
|
||||
(
|
||||
self.vehicle_mqtt_settings
|
||||
if control_transport == WIRELESS_MQTT_TRANSPORT
|
||||
else self.vehicle_can_settings
|
||||
).authorize(approval_token)
|
||||
if not parsed.get("actions") and not parsed.get("native_can_actions"):
|
||||
raise HardwareSafetyError(
|
||||
"hardware mode requires at least one verified seat or vehicle CAN operation"
|
||||
)
|
||||
if parsed.get("actions") and parsed.get("native_can_actions"):
|
||||
if self.hardware_settings.backend != "zlgcan":
|
||||
if (
|
||||
control_transport == WIRED_CAN_TRANSPORT
|
||||
and self.hardware_settings.backend != "zlgcan"
|
||||
):
|
||||
raise HardwareSafetyError(
|
||||
"linked seat/vehicle execution requires the shared zlgcan backend"
|
||||
)
|
||||
try:
|
||||
seat_channel = int(self.hardware_settings.channel, 0)
|
||||
except ValueError as exc:
|
||||
raise HardwareSafetyError(
|
||||
"ZLG seat CAN channel must be an integer"
|
||||
) from exc
|
||||
if seat_channel == self.vehicle_can_settings.channel:
|
||||
raise HardwareSafetyError(
|
||||
"seat and vehicle CAN must use different adapter channels"
|
||||
)
|
||||
if control_transport == WIRED_CAN_TRANSPORT:
|
||||
try:
|
||||
seat_channel = int(self.hardware_settings.channel, 0)
|
||||
except ValueError as exc:
|
||||
raise HardwareSafetyError(
|
||||
"ZLG seat CAN channel must be an integer"
|
||||
) from exc
|
||||
if seat_channel == self.vehicle_can_settings.channel:
|
||||
raise HardwareSafetyError(
|
||||
"seat and vehicle CAN must use different adapter channels"
|
||||
)
|
||||
self._trace(
|
||||
traces,
|
||||
request_id,
|
||||
@@ -1052,6 +1280,7 @@ class SeatDemoService:
|
||||
simulated_hardware_request=simulated_hardware_request,
|
||||
simulation_fault=simulation_fault,
|
||||
vehicle_profile=vehicle_profile,
|
||||
control_transport=control_transport,
|
||||
)
|
||||
|
||||
intent_ir = build_intent_ir(
|
||||
@@ -1366,10 +1595,41 @@ class SeatDemoService:
|
||||
|
||||
execute_started = time.perf_counter()
|
||||
if hardware_request:
|
||||
hardware_executor = self._new_hardware_executor()
|
||||
mqtt_selected = control_transport == WIRELESS_MQTT_TRANSPORT
|
||||
vehicle_safety_preflight = None
|
||||
if mqtt_selected:
|
||||
try:
|
||||
vehicle_safety_preflight = observe_vehicle_safety(
|
||||
self._vehicle_mqtt_transport.bus(channel=1),
|
||||
timeout_ms=min(
|
||||
5_000,
|
||||
max(1_000, self.vehicle_mqtt_settings.feedback_timeout_ms),
|
||||
),
|
||||
required_channel=1,
|
||||
)
|
||||
require_stationary_vehicle(vehicle_safety_preflight)
|
||||
except VehicleSafetyPreflightError as exc:
|
||||
raise HardwareSafetyError(
|
||||
"CAN1 vehicle safety preflight refused wireless passenger-seat execution: "
|
||||
f"{exc}"
|
||||
) from exc
|
||||
hardware_executor = self._new_hardware_executor(
|
||||
lambda: self._vehicle_mqtt_transport.bus(channel=0),
|
||||
remote_transport=True,
|
||||
)
|
||||
else:
|
||||
hardware_executor = self._new_hardware_executor()
|
||||
execution_report = hardware_executor.execute(
|
||||
command_plan, function_config, context["devices"]
|
||||
)
|
||||
if vehicle_safety_preflight is not None:
|
||||
execution_report["spec"]["vehicle_safety_preflight"] = (
|
||||
vehicle_safety_preflight
|
||||
)
|
||||
for item in execution_report["spec"].get("results", []):
|
||||
item.setdefault("telemetry", {})[
|
||||
"vehicle_safety_preflight"
|
||||
] = vehicle_safety_preflight
|
||||
elif simulated_hardware_request:
|
||||
execution_report = self.simulated_hardware_executor.execute(
|
||||
command_plan,
|
||||
@@ -2481,6 +2741,7 @@ class SeatDemoService:
|
||||
vehicle_profile: VehicleProfile,
|
||||
simulation_fault: str,
|
||||
mode_name: str,
|
||||
control_transport: str,
|
||||
) -> dict[str, Any]:
|
||||
"""Build, verify, and persist a new named mode in one user turn.
|
||||
|
||||
@@ -2502,6 +2763,7 @@ class SeatDemoService:
|
||||
approval_token,
|
||||
vehicle_profile.id,
|
||||
simulation_fault,
|
||||
control_transport=control_transport,
|
||||
)
|
||||
if source_result.get("status") not in {"succeeded", "partially_succeeded"}:
|
||||
source_result["decision_summary"] = [
|
||||
@@ -2519,6 +2781,7 @@ class SeatDemoService:
|
||||
None,
|
||||
vehicle_profile.id,
|
||||
"normal",
|
||||
control_transport=control_transport,
|
||||
)
|
||||
if saved_result.get("status") != "succeeded" or not saved_result.get(
|
||||
"mode_profile"
|
||||
@@ -2887,6 +3150,7 @@ class SeatDemoService:
|
||||
simulated_hardware_request: bool = False,
|
||||
simulation_fault: str = "normal",
|
||||
vehicle_profile: VehicleProfile | None = None,
|
||||
control_transport: str = WIRED_CAN_TRANSPORT,
|
||||
) -> dict[str, Any]:
|
||||
"""Run isolated adapters under the selected physical-bus policy."""
|
||||
vehicle_profile = vehicle_profile or self.vehicle_profiles.default()
|
||||
@@ -3194,6 +3458,7 @@ class SeatDemoService:
|
||||
hardware_request=hardware_request,
|
||||
simulated_hardware_request=simulated_hardware_request,
|
||||
simulation_fault=simulation_fault,
|
||||
control_transport=control_transport,
|
||||
)
|
||||
report_results = [
|
||||
item
|
||||
@@ -3470,21 +3735,33 @@ class SeatDemoService:
|
||||
hardware_request: bool,
|
||||
simulated_hardware_request: bool,
|
||||
simulation_fault: str,
|
||||
control_transport: str = WIRED_CAN_TRANSPORT,
|
||||
) -> dict[str, dict[str, Any]]:
|
||||
reports: dict[str, dict[str, Any]] = {}
|
||||
bridge = None
|
||||
seat_bus_factory = None
|
||||
native_bus_factory = None
|
||||
vehicle_safety_preflight: dict[str, Any] | None = None
|
||||
mqtt_selected = control_transport == WIRELESS_MQTT_TRANSPORT
|
||||
|
||||
if hardware_request and native_config_keys:
|
||||
shared_runtime_enabled = os.getenv(
|
||||
"COGNITIVE_AGENT_SHARED_CAN_RUNTIME_ENABLED",
|
||||
os.getenv(
|
||||
"COGNITIVE_AGENT_SEAT_SHARED_ZCANPRO_BRIDGE_ENABLED", "true"
|
||||
),
|
||||
).strip().lower() in {"1", "true", "yes", "on"}
|
||||
if shared_runtime_enabled:
|
||||
if hardware_request and (
|
||||
native_config_keys or (mqtt_selected and "seat" in configs)
|
||||
):
|
||||
shared_runtime_enabled = (
|
||||
not mqtt_selected
|
||||
and self.vehicle_can_settings.backend != "zlgcan-linux"
|
||||
and os.getenv(
|
||||
"COGNITIVE_AGENT_SHARED_CAN_RUNTIME_ENABLED",
|
||||
os.getenv(
|
||||
"COGNITIVE_AGENT_SEAT_SHARED_ZCANPRO_BRIDGE_ENABLED", "true"
|
||||
),
|
||||
).strip().lower() in {"1", "true", "yes", "on"}
|
||||
)
|
||||
if mqtt_selected:
|
||||
native_bus_factory = lambda: self._vehicle_mqtt_transport.bus(channel=1)
|
||||
if "seat" in configs:
|
||||
seat_bus_factory = lambda: self._vehicle_mqtt_transport.bus(channel=0)
|
||||
elif shared_runtime_enabled:
|
||||
from cognitive_agent.application.self_repair.service import (
|
||||
BRIDGE_MANAGER,
|
||||
)
|
||||
@@ -3531,9 +3808,14 @@ class SeatDemoService:
|
||||
native_bus_factory(),
|
||||
timeout_ms=min(
|
||||
5_000,
|
||||
max(1_000, self.vehicle_can_settings.feedback_timeout_ms),
|
||||
max(
|
||||
1_000,
|
||||
self.vehicle_mqtt_settings.feedback_timeout_ms
|
||||
if mqtt_selected
|
||||
else self.vehicle_can_settings.feedback_timeout_ms,
|
||||
),
|
||||
),
|
||||
required_channel=self.vehicle_can_settings.channel,
|
||||
required_channel=1,
|
||||
)
|
||||
require_stationary_vehicle(vehicle_safety_preflight)
|
||||
except VehicleSafetyPreflightError as exc:
|
||||
@@ -3560,7 +3842,9 @@ class SeatDemoService:
|
||||
executor = NativeCanExecutor(
|
||||
native_bus_factory,
|
||||
feedback_timeout_ms=(
|
||||
self.vehicle_can_settings.feedback_timeout_ms
|
||||
self.vehicle_mqtt_settings.feedback_timeout_ms
|
||||
if control_transport == WIRELESS_MQTT_TRANSPORT
|
||||
else self.vehicle_can_settings.feedback_timeout_ms
|
||||
),
|
||||
)
|
||||
native_reports[key] = executor.execute(
|
||||
@@ -3581,7 +3865,10 @@ class SeatDemoService:
|
||||
config = configs["seat"]
|
||||
if hardware_request:
|
||||
seat_executor = (
|
||||
self._new_hardware_executor(seat_bus_factory)
|
||||
self._new_hardware_executor(
|
||||
seat_bus_factory,
|
||||
remote_transport=mqtt_selected,
|
||||
)
|
||||
if seat_bus_factory is not None
|
||||
else self._new_hardware_executor()
|
||||
)
|
||||
|
||||
Reference in New Issue
Block a user