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
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
| """
needCode UWB CPD方案技术架构
核心组件：
1. UWB脉冲雷达前端（Qorvo QM33/QM35）
2. 微动/生命体征检测算法
3. Edge ML分类器（区分儿童/成人/宠物/物体）
4. 单节点多功能（CPD + 安全带提醒 + 入侵检测）
"""
import numpy as np
class UWBRadarCPD:
"""
UWB雷达儿童存在检测系统
needCode方案技术逆向
核心优势：
- 检测呼吸微动（0.1mm级位移）
- 区分活体/非活体
- 单节点覆盖多功能
- 无摄像头隐私问题
"""
def __init__(self):
self.config = {
'silicon': 'Qorvo QM35',
'band': (6.0e9, 8.5e9),
'bandwidth': 2.5e9,
'pulse_rate': 100e6,
'range_resolution': 0.06,
'max_range': 5,
'frame_rate': 20,
'mcu': 'Ambiq Apollo',
'power': 1.5,
'functions': ['cpd', 'seatbelt', 'intrusion', 'occupancy']
}
self.breathing_params = {
'adult_rate': (0.15, 0.35),
'child_rate': (0.25, 0.55),
'infant_rate': (0.4, 0.8),
'min_amplitude': 0.0001,
}
self.classifier = EdgeMLClassifier(
classes=['empty', 'child', 'adult', 'pet', 'object'],
model_size=256e3,
inference_time=0.005
)
def detect_breathing(self, radar_raw):
"""
UWB呼吸检测算法
核心原理：
- 胸壁呼吸运动幅度：0.1-2mm
- UWB脉冲雷达可检测亚毫米级位移
- 通过相位变化提取呼吸信号
Args:
radar_raw: shape=(n_pulses, n_range_bins)
Returns:
breathing_info: dict
"""
range_profile = self._pulse_compression(radar_raw)
target_bin = self._find_occupied_bin(range_profile)
phase_series = np.angle(range_profile[:, target_bin])
phase_unwrapped = np.unwrap(phase_series)
from scipy.signal import butter, filtfilt
nyq = self.config['frame_rate'] / 2
low = self.breathing_params['child_rate'][0] / nyq
high = self.breathing_params['child_rate'][1] / nyq
b, a = butter(2, [low, high], btype='band')
breathing_signal = filtfilt(b, a, phase_unwrapped)
from scipy.signal import periodogram
freqs, psd = periodogram(breathing_signal,
fs=self.config['frame_rate'])
breathing_freq = freqs[np.argmax(psd)]
breathing_amplitude = np.std(breathing_signal)
return {
'breathing_detected': breathing_amplitude > self.breathing_params['min_amplitude'],
'breathing_rate': breathing_freq * 60,
'amplitude': breathing_amplitude,
'classification': self._classify_by_breathing(breathing_freq, breathing_amplitude)
}
def _classify_by_breathing(self, freq, amplitude):
"""基于呼吸特征分类"""
if amplitude < self.breathing_params['min_amplitude']:
return 'empty_or_object'
if 0.4 <= freq <= 0.8:
return 'infant'
elif 0.25 <= freq <= 0.55:
return 'child'
elif 0.15 <= freq <= 0.35:
return 'adult'
else:
return 'unknown'
def multi_function_sensing(self, radar_raw):
"""
单节点多功能感知
needCode核心卖点：一个UWB节点覆盖4个功能
"""
results = {}
results['cpd'] = self.detect_child_presence(radar_raw)
results['occupancy'] = self._detect_seat_occupancy(radar_raw)
results['seatbelt'] = self._detect_seatbelt_state(radar_raw)
results['intrusion'] = self._detect_intrusion(radar_raw)
return results
|