Files
Robot_Arm/ml
..

机械臂避障策略:从数据到部署的运行手册

目标:在你的机器上从零跑出 Transformer 避障策略,并在查看器里直接用上。 方案依据见 docs/Transformer轨迹拟合训练方案.md。所有命令在仓库根目录执行。

按阶段执行 bash ml/pipeline.sh <阶段>,每一阶段完成后看本手册对应小节的「检查」再进下一步。

阶段 命令 预计耗时(28 核 CPU + RTX 3090) 产出
1 环境 bash ml/pipeline.sh setup 10 分钟 依赖
2 对拍 bash ml/pipeline.sh kin 1 分钟(实测 7.6 s 对拍) ml/assets/kin.json、对拍 PASS
3 老师门禁 bash ml/pipeline.sh gate1 25–30 分钟(单核) ml/data/consistency.json
4 生成数据 bash ml/pipeline.sh gen 不共识约 1 小时;共识约 4–5 小时 ml/data/shard_*.jsonl、stats.json
5 打包样本 bash ml/pipeline.sh prep 15–30 分钟 ml/data/samples/、ml/data/r2.json
6 预训练 bash ml/pipeline.sh train 测速 2000 步约 6 分钟,正式约 3 小时 ml/runs/base/best.pt
7 M5 门禁 bash ml/pipeline.sh m5 10–20 分钟 ml/runs/m5_gate_base.json
8 APG 微调 bash ml/pipeline.sh apg 以前 100 步速度为准(预计 2–4 小时) ml/runs/apg/best.pt
9 挖错循环 bash ml/pipeline.sh mine 每轮约 1–2 小时,3–6 轮 ml/runs/current.pt
10 导出 bash ml/pipeline.sh export 1 分钟 webapp/models/traj_policy.onnx(fp32)
11 部署评测 bash ml/pipeline.sh bench 约 1 小时(Node CPU,1120 个任务) ml/runs/policy_bench.json
12 验收汇总 bash ml/pipeline.sh accept 10–20 分钟 ml/runs/acceptance.json
13 使用 python ml/serve.py → 浏览器 ?policy=1 — —

第 2/4/5/6 步耗时为 RTX 3090 + 28 核实测换算,其余为估算,以每步首次输出的速度为准。


1. 环境

  • Linux / WSL2,或 Windows 原生 + Git Bash(实测第 2/4/5/6 步与闭环仿真可跑);NVIDIA 驱动 + CUDA(nvidia-smi 能看到 3090)
  • Node ≥ 18,Python 3.10–3.12
  • 脚本统一用 $PYTHON(默认 python)。Linux 上没有 python 命令时:export PYTHON=python3。Windows 不要用 python3(那是 WindowsApps 假壳)
  • 先按 CUDA 版本装 PyTorch(https://pytorch.org ),再:
git pull
bash ml/pipeline.sh setup          # pip install -r ml/requirements.txt;cd ml && npm install(onnxruntime-node)

2. 碰撞模型导出与对拍(必须 PASS)

bash ml/pipeline.sh kin

检查:最后打印的 JSON 里 "PASS": true(fk、姿态、组对间隙、83 维特征、间隙梯度与 JS 一致)。 docs/collide.json 以后只要重新拟合或重生成 pair2d/roadmap,这一步、数据、模型都要重来(指纹不符时各脚本会拒绝运行)。

3. 老师一致性门禁

bash ml/pipeline.sh gate1

看 consistentByGateRule:≥ 0.90 直接生成;< 0.90 时第 4 步自动加 --consensus 4(每条任务另跑 4 个 ±5 mm 邻居,与多数绕法不一致的样本丢弃,生成成本约 5 倍)。可用 CONSENSUS=0/1 手动覆盖。

4. 生成老师数据

bash ml/pipeline.sh gen                     # 默认 5 万条、进程数 = CPU 核数
# 自定义:N_TASKS=50000 NPROC=28 CONSENSUS=1 TARGET_SAMPLES=1700000 bash ml/pipeline.sh gen

不共识约 1.6 秒/条/核;共识约 8 秒/条/核。生成完自动统计;样本数不足 TARGET_SAMPLES(默认 170 万)时按实测「样本/任务」自动补生成(最多补 2 次),不用手动加 N_TASKS。

检查 ml/data/stats.json:

字段 不共识(实测) 共识(估算) 不正常时
keepRate ≈ 0.97 0.80–0.88 共识 < 0.75:把 stats.json 发我(老师左右跳变比预期多)
samplesPerTask ≈ 36.5 ≈ 36.5 —
samplesEvery3 ≥ 170 万(自动补量后) ≥ 170 万 补量后仍不足:发我
consensusDrop 0 约任务数的 10–20% —
vertexMinGapMm p50 ≈ 4.4、p90 ≈ 5.9 mm(p10 预计约 3) 同 p10 < 2.5 mm:发我(APG 与投影的 3 mm 余量要随之下调)
byCatMode C 类(贴立柱)各模式都有数千条 同 —

5. 打包训练样本 + R2 检查

bash ml/pipeline.sh prep

每条轨迹按 50 Hz 时间律重放,每 3 步取一个样本(特征与部署同一份 JS 代码计算),30% 样本加 σ = 1° 噪声增广。 检查 ml/data/samples/index.json:train_samples 约 170 万、val_samples 约 9 万(5% 任务划为 val)。 随后自动跑 R2 检查(ml/data/r2.json):近邻样本前 3 步标签差 label_std_mean < 0.10(10% 步长)为通过;不通过先发我,不要直接训练。

6. 预训练

bash ml/pipeline.sh train                           # MeanFlow 头 → ml/runs/bench_base/、ml/runs/base/

先跑 2000 步测吞吐(ml/runs/bench_base/log.jsonl 的 samples_per_s,eta_h 是剩余小时数),再正式训练到 60000 步或闭环到达率连续 5 次不升为止。

  • 通过线(R10):samples_per_s ≥ 5000,即 60000 步 ≤ 3.5 小时。参考:3090、batch 1024 实测 6.2 k 样本/s ≈ 2.8 小时。MeanFlow 的 JVP 双前向使训练受算力限制,加大 batch 不会提高样本/s;低于通过线时把 configs/base.json 的 fk_caps 从 96 降到 48,仍不够再把 steps 降到 40000
  • 训练中每 2000 步打印一行 EVAL {...}:val 任务闭环(部署节奏、不开安全层)success、collision_rate、time_ok_1p3、start_fail。时限 = 老师时长 × 2(至少 3 s)
  • 显存不够把 batch 改成 512。中断后续训(日志追加;新训练会覆盖旧日志):
python -m ml.train --samples ml/data/samples --out ml/runs/base --resume ml/runs/base/last.pt

7. M5 门禁:选定动作头

bash ml/pipeline.sh m5

1000 个贴立柱任务(无老师题,定长 6 s 时限)跑两遍,结果在 ml/runs/m5_gate_base.json:

  • policy_only:关安全层的纯策略指标。门禁只看这一项:穿柱率 ≤ 2% 通过,通过后把该模型记为选定模型(ml/runs/selected_ckpt),后续阶段自动从它开始
  • with_sim_safety:仿真里的近似安全层(候选逐步干涉就换下一条)。只作参考

三种口径的关系:M5 是纯策略能力;仿真安全层是近似;部署能不能过只看第 11 步(与浏览器同一份运行时,含投影、距离认证、刹停、预算、换向锁)。三者互不替代。

不通过(或训练日志出现「训练发散」)则换 WTA K=8 头。WTA 的产物在独立目录,不会覆盖 MeanFlow:

CFG=ml/configs/wta.json bash ml/pipeline.sh train    # → ml/runs/bench_wta/、ml/runs/wta/
CFG=ml/configs/wta.json bash ml/pipeline.sh m5       # → ml/runs/m5_gate_wta.json;通过则选定 wta

需要强制指定后续阶段的起点模型时用 CKPT=路径 bash ml/pipeline.sh apg。

8. APG 可微微调

bash ml/pipeline.sh apg

按部署节奏(每次推理提交 3 步、50 Hz)可微展开策略,优化到达、碰撞余量、平滑与行程,并保留 BC 锚定。每 500 步闭环验证,按到达率存 best.pt,完成后复制为 ml/runs/current.pt。

  • 展开长度:每批覆盖该批老师时长 p90 × 1.2(无老师题按 6 s),在 60–150 次推理(3.6–9 s)之间;日志 plans 字段是本批实际次数
  • 到达项:每 10 次推理段末的 TCP 距离与姿态误差,没有「到达即停」。这是有意的:段末项在整条展开上持续给出接近目标的梯度
  • 碰撞项:每步端点 + 中点的逐胶囊对铰链 ReLU(3 mm − 间隙)。3 mm ≈ 老师轨迹最小间隙的 p10(p50 4.4 mm),避免碰撞项与 BC 标签对抗;运行时投影余量同为 3 mm
  • 显存不够把 configs/apg.json 的 batch 降到 64,或把 seg_plans 从 10 降到 5

9. 挖错循环

bash ml/pipeline.sh mine            # 默认 6 轮;ROUNDS=3 APG_STEPS=1000 MINE_N=50000 可调

每轮:5 万道新题关安全层作答 → 错题分类 E1–E5 → 本轮错题与邻居进 APG 采样池(不累积历史轮,旧错题由门禁的「上轮修好仍对 ≥ 95%」把关)→ E2(局部极小)请老师补少量路径 → APG 微调 → 门禁集比较,不达标自动回滚。连续 2 轮提升 < 0.5 个百分点自动停止。

门禁(ml/runs/mine/r*/gate.json):到达率不降、A 类降幅 ≤ 0.5 个百分点、上轮修好的题 ≥ 95% 仍对、R7:B/C 类左右绕行比例变化 ≤ 5 个百分点、行程中位数比 ≤ 1.05。挖错题与门禁集都是无老师题,到达按定长 6 s 判,time_ok_1p3 与行程比只在有老师参考的题上统计(门禁集上为 null)。

10. 导出

bash ml/pipeline.sh export          # fp32 ONNX + meta.json → webapp/models/(约 20 MB)

默认 fp32:部署走 wasm 与 Node CPU,fp16 在 CPU 后端上不保证更快。只有第 13 步用 &ep=webgpu 实测 __POLICY.latency() 明显受益时,才另导出 fp16 做对比:

pip install onnxconverter-common
python -m ml.export_onnx --ckpt ml/runs/current.pt --out webapp/models/traj_policy_fp16.onnx --fp16

11. 部署形态评测(策略 + 安全层)

bash ml/pipeline.sh bench

跑与浏览器同一份运行时(webapp/js/ik-policy.js):贴立柱 30 例(pos、pose 各一遍)、直线被挡 40 例、R8 对抗 50 例(J1 起终差 ≥ 140°、终点贴立柱、两侧都要绕远)、一次性贴立柱扩展集 1000 例。各集合数量可用 --nc-n / --route-n / --r8-n 单独调。

看 ml/runs/policy_bench.json:各集合 collisionFrames 为 0;near_column_* 与 route40 全部 ok;near_column_1000 0 失败;brakeRate < 0.02;r8_adversarial 的 recoveryRate ≥ 0.95、livelock = 0。 Node 里的推理/安全层耗时只作参考,浏览器延迟用第 13 步实测。

12. 验收汇总

bash ml/pipeline.sh accept

自己补跑 val 全部任务的闭环(开仿真安全层):可达任务到达率 ≥ 98%、D 类停靠距离 ≤ 老师 + 5 mm、起步失败 = 0;再读第 5–11 步产物核对 R2、R7、R8、R10、M5 与部署形态各项。逐项打印「通过 / 未过」,结果在 ml/runs/acceptance.json。

13. 在查看器里使用

python -m arm.viewer.build_viewer   # 若 webapp/generated/00_data.js 还没生成(查看器原有构建步骤)
python ml/serve.py                  # 带跨源隔离头的本地服务,wasm 可用多线程

浏览器打开 http://localhost:8000/?policy=1:右上角徽标显示「策略模式就绪」后,拖动黄球或松手,手臂由策略闭环执行(不调用任何规划器)。

  • &ep=webgpu 改用 WebGPU 后端对比延迟
  • 控制台 __POLICY.latency() 查看推理与安全层的 P50/P99;__POLICY.stats() 查看刹停、换向、精修次数
  • 工具偏移 ≠ 0 时自动交回原规划器
  • 离线环境:把 onnxruntime-web 的 ort.min.js 与 wasm 文件放到 webapp/vendor/ort/,地址加 &ortLocal=1

14. 回传给我

步骤 文件
2 对拍输出(终端 JSON)
3–5 ml/data/consistency.json、ml/data/stats.json、ml/data/samples/index.json、ml/data/r2.json
6 ml/runs/bench_base/log.jsonl(测速)、ml/runs/base/log.jsonl
7 ml/runs/m5_gate_*.json
8–9 ml/runs/apg/log.jsonl、ml/runs/mine/r*/report.json 与 gate.json
11–13 ml/runs/policy_bench.json、ml/runs/acceptance.json、浏览器 __POLICY.latency() 输出

常见问题

  • 指纹不符:collide.json 变了。依次重跑第 2、4、5 步并重训。
  • 训练发散(loss 出现 nan/inf,自动停在 diverged.pt):先把 lr 降到 5e-4 重试一次,仍发散就走 WTA 回退(第 7 步)。
  • 显存/内存不足:降 batch;APG 还可把 seg_plans 降到 5。出题与间隙计算已分块(每块 512 个位形)。
  • 小样本摸底:几百条任务时 val 可能为空,训练会提示并跳过闭环验证。
  • 浏览器只有 1 线程:没走 ml/serve.py(缺 COOP/COEP 头)。
  • 查看器徽标「策略模式不可用」:看控制台报错,多为模型文件缺失、指纹或 TCP 不符。

文件地图

ml/
  pipeline.sh              一条龙阶段脚本(环境变量见文件头)
  gen/                     老师数据:sampler / teacher(确定性 PRM A*)/ cert.cjs(距离下界认证,实现在 ik-policy.js)/
                           pathdev.cjs(同伦类判定,共识过滤与一致性门禁用)/ timelaw / gen_dataset / consistency / stats / run_parallel.sh
  prep/                    export_kin.cjs(→ assets/kin.json)、build_dataset.cjs(→ samples/*.npy)、npy.cjs(.npy 写出)、run_prep.sh
  common/                  kin_torch.py(可微运动学 + 胶囊间隙)、features.py(83 维特征,与 JS 逐项一致)
  model/                   policy.py(Transformer + MeanFlow / WTA 头)、meanflow.py
  data.py  train.py        样本加载、预训练
  sim/closed_loop.py       部署节奏闭环仿真(验证 / 挖错 / 门禁)
  apg/apg_finetune.py      APG 可微微调
  mining/                  tasks.py(无老师出题)、mine_round.py、gate.py(含 R7)、loop.sh
  eval/                    dump_parity.cjs + check_parity.py(JS↔PyTorch 对拍)、check_r2.py(R2)、acceptance.py(验收汇总)
  toy/toy_bimodal.py       2D 双模态对照实验(动作头选型依据)
  export_onnx.py  serve.py
  configs/                 base.json(MeanFlow)、wta.json(回退)、apg.json
webapp/js/ik-policy.js       运行时:特征、距离下界认证、刹停、投影、精修、Runner(浏览器与 Node 共用)
webapp/js/ik-policy-glue.js  查看器接入(?policy=1)
tests/policy_bench.cjs       部署形态评测(nc / route / r8 / nc1000)