R2R2R LOOP — PHASE 1 PROOF

01 ブロックをPICK位置に置く SETUP
人がブロックをロボットのPICK座標に置く。この時点でカメラはPLACE位置を監視している。ループの起点。
02 pick_and_place.py 実行 ROBOT
Pi上でスクリプトを実行。HOME → APPROACH_PICK → PICK(グリッパー閉じる)→ APPROACH_PLACE → PLACE(中間姿勢でグリッパー開く)→ HOME の順で動作する。所要時間約50秒。
03 10秒待機 WAIT
ロボットがHOME位置に完全に戻るまで待つ。カメラ判定はロボットが視界から外れた後に行う。ロボットが邪魔して赤色を隠さないようにするため。
04 iPhoneカメラで赤色検出 DETECT
Iriun Webcam経由でiPhoneカメラの映像をOpenCVで取得。ROI内をHSV変換して赤色ピクセルの割合を計算する。閾値は5%。

lower_red: H(0-10) S(100-255) V(100-255)
upper_red: H(160-180) S(100-255) V(100-255)
05 判定 → SUCCESS / RETRY JUDGE
赤色割合が5%以上 → OBJECT DETECTED → ループ完了。5%未満 → NO OBJECT → 最大3回リトライ。3回失敗でFAILED終了。
ATTEMPT 1/3 — RESULT
OBJECT DETECTED ✓
25.9%
red ratio
tap each step to expand