mouxangithub
5e253a54ba
新增 Toyota Wildlander PHEV 车型的指纹、参数配置和相关控制逻辑，包括： - 在 substitute.toml 中将其映射为 TOYOTA_RAV4_TSS2 以复用现有参数 - 增加车辆指纹识别信息 - 配置车辆规格参数（质量、轴距、转向比等） - 更新 carstate 和 interface 逻辑以适配该车型 - 添加对应的神经网络前馈模型文件 此外，临时注释了 controlsd.py 中的无 GPS 事件触发逻辑，待后续修复。
56 lines
1.8 KiB
Python
Executable File
56 lines
1.8 KiB
Python
Executable File
#!/usr/bin/env python3
|
|
import gc
|
|
|
|
import cereal.messaging as messaging
|
|
from openpilot.common.params import Params
|
|
from openpilot.common.realtime import set_realtime_priority
|
|
from openpilot.selfdrive.monitoring.helpers import DriverMonitoring
|
|
|
|
|
|
def dmonitoringd_thread():
|
|
gc.disable()
|
|
set_realtime_priority(2)
|
|
|
|
params = Params()
|
|
pm = messaging.PubMaster(['driverMonitoringState'])
|
|
sm = messaging.SubMaster(['driverStateV2', 'liveCalibration', 'carState', 'controlsState', 'modelV2', 'carControl'], poll='driverStateV2')
|
|
|
|
DM = DriverMonitoring(rhd_saved=params.get_bool("IsRhdDetected"), always_on=params.get_bool("AlwaysOnDM"))
|
|
|
|
# FrogPilot variables
|
|
driver_view_enabled = params.get_bool("IsDriverViewEnabled")
|
|
|
|
# 20Hz <- dmonitoringmodeld
|
|
while True:
|
|
sm.update()
|
|
if not sm.updated['driverStateV2']:
|
|
# iterate when model has new output
|
|
continue
|
|
|
|
valid = sm.all_checks()
|
|
if DM.always_on and valid:
|
|
DM.run_step(sm)
|
|
elif DM.always_on and driver_view_enabled:
|
|
DM.face_detected = sm['driverStateV2'].leftDriverData.faceProb > DM.settings._FACE_THRESHOLD or sm['driverStateV2'].rightDriverData.faceProb > DM.settings._FACE_THRESHOLD
|
|
|
|
# publish
|
|
dat = DM.get_state_packet(valid=valid or driver_view_enabled)
|
|
pm.send('driverMonitoringState', dat)
|
|
|
|
# load live always-on toggle
|
|
if sm['driverStateV2'].frameId % 40 == 1:
|
|
DM.always_on = params.get_bool("AlwaysOnDM")
|
|
|
|
# save rhd virtual toggle every 5 mins
|
|
if (sm['driverStateV2'].frameId % 6000 == 0 and
|
|
DM.wheelpos_learner.filtered_stat.n > DM.settings._WHEELPOS_FILTER_MIN_COUNT and
|
|
DM.wheel_on_right == (DM.wheelpos_learner.filtered_stat.M > DM.settings._WHEELPOS_THRESHOLD)):
|
|
params.put_bool_nonblocking("IsRhdDetected", DM.wheel_on_right)
|
|
|
|
def main():
|
|
dmonitoringd_thread()
|
|
|
|
|
|
if __name__ == '__main__':
|
|
main()
|