qing
9179281420
- v3-P2-1: _npu_test/_onnx_validate 按 normalize_mode 分支（fixed_range 免 stats， HailoPredictor 透传模式，torch 参考同口径反归一化） - v3-P2-2: export_deploy/export_onnx 一致性 diff 超 1e-4 即 sys.exit（P2-f 闭环） - v3-P2-3: run_loop overrun 告警节流（第1次+每100次），降 hz 建议仅 >10% 输出 - P2-a1: default_column_weights 扩展列（action_dim>18）默认 1.0 - P2-c: 补 predictor 异常清理路径测试（异常传播 + finally 落盘） - P2-d/P2-e: Resize 口径与 resume scheduler T_max 语义文档化 - R2-4: _set.sh 安装后断言 CPU 版 torch，误装 CUDA 即拦截 测试: pybot 89 passed (+1)、actpred 148 passed/18 skipped
67 lines
3.1 KiB
Python
67 lines
3.1 KiB
Python
"""动作向量固定物理范围归一化 —— 训练（dataset/pretrain_mt）与推理
|
||
（predict / onnx_infer / hailo_infer / gen_calibration / export_deploy）共用
|
||
|
||
18 列动作向量的物理量纲（pybot 侧契约）：
|
||
0-9 舵机角度 [0, 180]°（pybot/hd/servo.py MAX_ANGLE=180.0 校准后全行程）
|
||
10 spk.F 扬声器频率 [0, 5000] Hz（@Speaker max_f=5000）
|
||
11 spk.delay 延时 [0, 2000] ms（脚本实用上限，std.mt 用 10-500）
|
||
12-17 保留位（恒 0，hi-lo=1.0 使归一化后仍为 0；损失权重 0 不参与优化）
|
||
|
||
min-max 映射到 [0,1]：x_norm = clip((x - lo) / (hi - lo), 0, 1)。
|
||
与 z-score 的区别：固定物理范围不依赖 action_stats.npy 数据统计文件，
|
||
部署链零状态；clamp 防御真实数据越界（越界值截断到 [0,1]，不扩散）。
|
||
|
||
仅依赖 numpy，保证 hailo_infer.py（HAT 部署环境无 torch）可直接复用。
|
||
"""
|
||
|
||
import numpy as np
|
||
|
||
# 各列物理下界（当前全 0；保留数组以便未来引入非零下界列）
|
||
ACTION_LO = np.zeros(18, dtype=np.float32)
|
||
# 各列物理上界（18 列标准布局；action_dim 不同用 action_bounds() 适配）
|
||
ACTION_HI = np.array(
|
||
[180.0] * 10 + # 0-9 舵机角
|
||
[5000.0, 2000.0] + # 10 spk.F，11 spk.delay
|
||
[1.0] * 6, # 12-17 保留位（恒 0，span=1.0 保持归一化后为 0）
|
||
dtype=np.float32)
|
||
|
||
|
||
def action_bounds(action_dim: int = 18):
|
||
"""(lo, hi) 物理界：action_dim ≤ 18 取前缀；> 18 的超出列按 [0, 1] 补足"""
|
||
if action_dim <= len(ACTION_LO):
|
||
return ACTION_LO[:action_dim], ACTION_HI[:action_dim]
|
||
pad = action_dim - len(ACTION_LO)
|
||
return (np.concatenate([ACTION_LO, np.zeros(pad, dtype=np.float32)]),
|
||
np.concatenate([ACTION_HI, np.ones(pad, dtype=np.float32)]))
|
||
|
||
|
||
def normalize_action(action, action_dim: int = None) -> np.ndarray:
|
||
"""原始动作向量 → [0,1] 归一化向量（clamp 防御越界值）
|
||
|
||
action: (..., action_dim) 任意前导维；action_dim 缺省取末维长度。
|
||
"""
|
||
a = np.asarray(action, dtype=np.float32)
|
||
lo, hi = action_bounds(action_dim or a.shape[-1])
|
||
return np.clip((a - lo) / (hi - lo), 0.0, 1.0)
|
||
|
||
|
||
def denormalize_action(norm_action, action_dim: int = None) -> np.ndarray:
|
||
"""[0,1] 归一化向量 → 原始动作向量（不 clamp，保留模型外推能力）"""
|
||
n = np.asarray(norm_action, dtype=np.float32)
|
||
lo, hi = action_bounds(action_dim or n.shape[-1])
|
||
return n * (hi - lo) + lo
|
||
|
||
|
||
def default_column_weights(action_dim: int = 18) -> np.ndarray:
|
||
"""逐列损失权重默认表：舵机 1.0（安全关键）、spk 0.2（保留梯度）、
|
||
保留位 0.0（恒 0 纯噪声，参与只会稀释有效梯度）。
|
||
action_dim>18 的扩展列默认 1.0：超出当前 18 列语义布局的通道视为
|
||
新执行器，静默给 0 会让其完全不参与训练（P2-a1）。"""
|
||
w = np.zeros(action_dim, dtype=np.float32)
|
||
w[:min(10, action_dim)] = 1.0
|
||
if action_dim > 10:
|
||
w[10:min(12, action_dim)] = 0.2
|
||
if action_dim > 18:
|
||
w[18:] = 1.0
|
||
return w
|