|
|
|
|
@@ -1,8 +1,11 @@
|
|
|
|
|
import os
|
|
|
|
|
import json
|
|
|
|
|
import math
|
|
|
|
|
|
|
|
|
|
from cereal import messaging, log
|
|
|
|
|
from openpilot.common.basedir import BASEDIR
|
|
|
|
|
from openpilot.common.params import Params
|
|
|
|
|
from openpilot.common.swaglog import cloudlog
|
|
|
|
|
from openpilot.selfdrive.ui.onroad.driver_camera_dialog import DriverCameraDialog
|
|
|
|
|
from openpilot.selfdrive.ui.ui_state import ui_state
|
|
|
|
|
from openpilot.selfdrive.ui.layouts.onboarding import TrainingGuide
|
|
|
|
|
@@ -20,10 +23,7 @@ from openpilot.system.ui.widgets.scroller import Scroller
|
|
|
|
|
DESCRIPTIONS = {
|
|
|
|
|
'pair_device': "Pair your device with comma connect (connect.comma.ai) and claim your comma prime offer.",
|
|
|
|
|
'driver_camera': "Preview the driver facing camera to ensure that driver monitoring has good visibility. (vehicle must be off)",
|
|
|
|
|
'reset_calibration': (
|
|
|
|
|
"openpilot requires the device to be mounted within 4° left or right and within 5° " +
|
|
|
|
|
"up or 9° down. openpilot is continuously calibrating, resetting is rarely required."
|
|
|
|
|
),
|
|
|
|
|
'reset_calibration': "openpilot requires the device to be mounted within 4° left or right and within 5° up or 9° down.",
|
|
|
|
|
'review_guide': "Review the rules, features, and limitations of openpilot",
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
@@ -49,12 +49,15 @@ class DeviceLayout(Widget):
|
|
|
|
|
self._pair_device_btn = button_item("Pair Device", "PAIR", DESCRIPTIONS['pair_device'], callback=self._pair_device)
|
|
|
|
|
self._pair_device_btn.set_visible(lambda: not ui_state.prime_state.is_paired())
|
|
|
|
|
|
|
|
|
|
self._reset_calib_btn = button_item("Reset Calibration", "RESET", DESCRIPTIONS['reset_calibration'], callback=self._reset_calibration_prompt)
|
|
|
|
|
self._reset_calib_btn.set_description_opened_callback(self._update_calib_description)
|
|
|
|
|
|
|
|
|
|
items = [
|
|
|
|
|
text_item("Dongle ID", dongle_id),
|
|
|
|
|
text_item("Serial", serial),
|
|
|
|
|
self._pair_device_btn,
|
|
|
|
|
button_item("Driver Camera", "PREVIEW", DESCRIPTIONS['driver_camera'], callback=self._show_driver_camera, enabled=ui_state.is_offroad),
|
|
|
|
|
button_item("Reset Calibration", "RESET", DESCRIPTIONS['reset_calibration'], callback=self._reset_calibration_prompt),
|
|
|
|
|
self._reset_calib_btn,
|
|
|
|
|
button_item("Review Training Guide", "REVIEW", DESCRIPTIONS['review_guide'], self._on_review_training_guide),
|
|
|
|
|
regulatory_btn := button_item("Regulatory", "VIEW", callback=self._on_regulatory),
|
|
|
|
|
button_item("Change Language", "CHANGE", callback=self._show_language_selection, enabled=ui_state.is_offroad),
|
|
|
|
|
@@ -95,19 +98,68 @@ class DeviceLayout(Widget):
|
|
|
|
|
gui_app.set_modal_overlay(alert_dialog("Disengage to Reset Calibration"))
|
|
|
|
|
return
|
|
|
|
|
|
|
|
|
|
def reset_calibration(result: int):
|
|
|
|
|
# Check engaged again in case it changed while the dialog was open
|
|
|
|
|
if ui_state.engaged or result != DialogResult.CONFIRM:
|
|
|
|
|
return
|
|
|
|
|
|
|
|
|
|
self._params.remove("CalibrationParams")
|
|
|
|
|
self._params.remove("LiveTorqueParameters")
|
|
|
|
|
self._params.remove("LiveParameters")
|
|
|
|
|
self._params.remove("LiveParametersV2")
|
|
|
|
|
self._params.remove("LiveDelay")
|
|
|
|
|
self._params.put_bool("OnroadCycleRequested", True)
|
|
|
|
|
self._update_calib_description()
|
|
|
|
|
|
|
|
|
|
dialog = ConfirmDialog("Are you sure you want to reset calibration?", "Reset")
|
|
|
|
|
gui_app.set_modal_overlay(dialog, callback=self._reset_calibration)
|
|
|
|
|
gui_app.set_modal_overlay(dialog, callback=reset_calibration)
|
|
|
|
|
|
|
|
|
|
def _reset_calibration(self, result: int):
|
|
|
|
|
if ui_state.engaged or result != DialogResult.CONFIRM:
|
|
|
|
|
return
|
|
|
|
|
def _update_calib_description(self):
|
|
|
|
|
desc = DESCRIPTIONS['reset_calibration']
|
|
|
|
|
|
|
|
|
|
self._params.remove("CalibrationParams")
|
|
|
|
|
self._params.remove("LiveTorqueParameters")
|
|
|
|
|
self._params.remove("LiveParameters")
|
|
|
|
|
self._params.remove("LiveParametersV2")
|
|
|
|
|
self._params.remove("LiveDelay")
|
|
|
|
|
self._params.put_bool("OnroadCycleRequested", True)
|
|
|
|
|
calib_bytes = self._params.get("CalibrationParams")
|
|
|
|
|
if calib_bytes:
|
|
|
|
|
try:
|
|
|
|
|
calib = messaging.log_from_bytes(calib_bytes, log.Event).liveCalibration
|
|
|
|
|
|
|
|
|
|
if calib.calStatus != log.LiveCalibrationData.Status.uncalibrated:
|
|
|
|
|
pitch = math.degrees(calib.rpyCalib[1])
|
|
|
|
|
yaw = math.degrees(calib.rpyCalib[2])
|
|
|
|
|
desc += f" Your device is pointed {abs(pitch):.1f}° {'down' if pitch > 0 else 'up'} and {abs(yaw):.1f}° {'left' if yaw > 0 else 'right'}."
|
|
|
|
|
except Exception:
|
|
|
|
|
cloudlog.exception("invalid CalibrationParams")
|
|
|
|
|
|
|
|
|
|
lag_perc = 0
|
|
|
|
|
lag_bytes = self._params.get("LiveDelay")
|
|
|
|
|
if lag_bytes:
|
|
|
|
|
try:
|
|
|
|
|
lag_perc = messaging.log_from_bytes(lag_bytes, log.Event).liveDelay.calPerc
|
|
|
|
|
except Exception:
|
|
|
|
|
cloudlog.exception("invalid LiveDelay")
|
|
|
|
|
if lag_perc < 100:
|
|
|
|
|
desc += f"<br><br>Steering lag calibration is {lag_perc}% complete."
|
|
|
|
|
else:
|
|
|
|
|
desc += "<br><br>Steering lag calibration is complete."
|
|
|
|
|
|
|
|
|
|
torque_bytes = self._params.get("LiveTorqueParameters")
|
|
|
|
|
if torque_bytes:
|
|
|
|
|
try:
|
|
|
|
|
torque = messaging.log_from_bytes(torque_bytes, log.Event).liveTorqueParameters
|
|
|
|
|
# don't add for non-torque cars
|
|
|
|
|
if torque.useParams:
|
|
|
|
|
torque_perc = torque.calPerc
|
|
|
|
|
if torque_perc < 100:
|
|
|
|
|
desc += f" Steering torque response calibration is {torque_perc}% complete."
|
|
|
|
|
else:
|
|
|
|
|
desc += " Steering torque response calibration is complete."
|
|
|
|
|
except Exception:
|
|
|
|
|
cloudlog.exception("invalid LiveTorqueParameters")
|
|
|
|
|
|
|
|
|
|
desc += "<br><br>"
|
|
|
|
|
desc += ("openpilot is continuously calibrating, resetting is rarely required. " +
|
|
|
|
|
"Resetting calibration will restart openpilot if the car is powered on.")
|
|
|
|
|
|
|
|
|
|
self._reset_calib_btn.set_description(desc)
|
|
|
|
|
|
|
|
|
|
def _reboot_prompt(self):
|
|
|
|
|
if ui_state.engaged:
|
|
|
|
|
|