位置を紐づける経路 ― teach は Pi、検出は Mac

手で教えた軌道(Pi 直結)と、上カメラで取った対象物位置(Mac)を、ひとつの JSON に合流させる。daemon もルールも触らず、空いていた positions の枠を後から埋める。

▶ 各ステップをクリックすると、その段が JSON のどの部分を作るかが光る
PI / 直結
STEP A
空荷で teach
脱力して手でなぞる。4 工程とグリッパー印、関節角列が記録される。カメラは Pi では動かず positions=null。
MAC / カメラ
STEP B
上カメラで位置取得
同じ配置のまま detect_positions_once.py を実行。block / box の Unity 座標を 5 回中央値で取る。
↓   ↓
STEP C ― 差し込み(positions の枠を埋める)
MERGE
teach JSON ← 位置 JSON
クリックで両方が同時に光る。軌道と位置が同じ配置を指す一本になる。
{ "phases": [ APPROACH_PICK, PICK, APPROACH_PLACE, PLACE ], "gripper_events": [ close@270, open@565 ], "angles": [ [...], [...], ... 612 poses ], "rel_time_sec": [ ... ], "positions": { "block_xz_m": [0.1975, 0.2421], "box_xz_m": [-0.0103, 0.1076], "detect_score": { "box": 0.648 }, "source": "detect_positions_once.py (n=5)" } }
軌道(Pi teach) 位置(Mac 検出)