LOG173で確定: PICK j2=102.74° は実機未到達(実測上限+90.7°)。
CSV検索条件: j2 ≤ 88° / EE目標 (0.2403, 0.0111, 0.2135) / XZ距離昇順
TOP1: [-46.93, 87.74, -33.33, 3.6, -45.11, -30.0]
XZ 1.30mmj2 87.74°ee_y 25mm
実測angles: [-46.84, 88.41, -33.31, 3.86, -46.31, -30.41]
is_moving = 0 到達確定。最大差分 1.20°。
旧定数 ee_y≒66mm → 低すぎ → +40mm再検索
ee_y=118mm候補 → j3=11.0で爪傾く → j3=3.6固定で再々検索
最終: [-46.93, 87.74, -38.33, 3.6, -70.11, -30.0] ee_y=111mm
HOME → APPROACH_PICK(爪開放) → PICK(把持) → 持ち上げ
赤ブロックを掴んで空中に持ち上げた。