1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
| """
驾驶员失能干预系统架构
对应Euro NCAP 2026 DMS-ADAS协同要求
"""
class DriverIncapacitationResponse:
"""
DMS检测到驾驶员失能后的标准响应流程
关键指标：
- 检测延迟：≤5s
- 靠边停车时间：≤60s（城市道路）
- 紧急呼叫：≤90s
"""
STAGES = [
{
'name': 'detection',
'duration': (0, 5),
'trigger': 'no_eye_movement + no_hand_movement > 5s',
'action': 'log_status + visual_alert'
},
{
'name': 'warning',
'duration': (5, 10),
'trigger': 'driver_no_response',
'action': 'audio_alert + haptic_alert + start_slowdown'
},
{
'name': 'lane_change',
'duration': (10, 30),
'trigger': 'speed < 30km/h',
'action': 'signal + lane_change_to_shoulder'
},
{
'name': 'stop',
'duration': (30, 60),
'trigger': 'safe_stopping_zone',
'action': 'full_stop + park + handbrake'
},
{
'name': 'emergency',
'duration': (60, 90),
'trigger': 'vehicle_stopped',
'action': 'call_emergency_services + unlock_doors'
}
]
def __init__(self):
self.redundant_systems = {
'braking': 'electronic_redundant',
'steering': 'steer_by_wire_redundant',
'propulsion': 'backup_drive',
'communication': 'emergency_comm_redundant',
'door_unlock': 'mechanical_backup'
}
def execute_stage(self, stage_name, vehicle_state):
"""执行干预阶段"""
stage = next(s for s in self.STAGES if s['name'] == stage_name)
if stage_name == 'detection':
return self._check_driver_responsiveness(vehicle_state)
elif stage_name == 'warning':
return self._issue_warnings(vehicle_state)
elif stage_name == 'lane_change':
return self._safe_lane_change(vehicle_state)
elif stage_name == 'stop':
return self._safe_stop(vehicle_state)
elif stage_name == 'emergency':
return self._call_emergency(vehicle_state)
def _check_driver_responsiveness(self, state):
"""
检测驾驶员无响应
多模态检测：
1. DMS摄像头：无眼球运动 + 眼睑闭合 > 5s
2. 方向盘：无手部接触/扭矩输入
3. 座椅压力：乘员仍在位（排除离车）
4. 踏板：无操作输入
"""
checks = {
'eye_movement': state['dms'].get('eye_movement', False),
'eye_closure': state['dms'].get('perclos', 0) > 0.8,
'hand_on_wheel': state['steering'].get('hand_torque', 0) > 0.5,
'seat_occupied': state['seat'].get('pressure', 0) > 10,
'pedal_input': state['pedals'].get('any_input', False)
}
incapacitated = (
not checks['eye_movement'] and
checks['eye_closure'] and
not checks['hand_on_wheel'] and
checks['seat_occupied'] and
not checks['pedal_input']
)
return incapacitated
|