Skip to content

measure_distance — วัดระยะทางระหว่างจุดอ้างอิง ​

โมดูล measure_distance ใช้สำหรับวัดระยะทางแบบยุคลิด (Euclidean Distance) ระหว่างจุด 2 จุด (Point A และ Point B) โดยแต่ละจุดสามารถเลือกอ้างอิงจากระบบพิกัดภาพ (image), ระบบพิกัดชิ้นงาน (fixture), หรือจุดศูนย์กลางของชิ้นงานที่ตรวจจับได้ (blob) พร้อมแปลงหน่วยเป็นมิลลิเมตรโดยอัตโนมัติเมื่อมีการ Calibrate กล้องไว้

1. การใช้งานใน Recipe ​

  • Inputs:
    • pose (จำเป็นเมื่อ aMode หรือ bMode เป็น "fixture"): stepId ของ Fixture
    • blob (จำเป็นเมื่อ aMode หรือ bMode เป็น "blob"): stepId ของโมดูล blob
    • roi (ไม่บังคับ): stepId ของ roi_rect — ใช้สำหรับแปลงพิกัด Centroid ของ Blob จากพิกัดภายใน ROI กลับเป็นพิกัดภาพจริง
  • Parameters:
    • aMode, bMode (string, ค่าเริ่มต้น "fixture" และ "blob"): โหมดของจุด A และจุด B ("fixture", "image", หรือ "blob")
    • ax, ay (double, ค่าเริ่มต้น 0.0): พิกัดของจุด A (ใช้เมื่อ aMode เป็น "fixture" หรือ "image")
    • bx, by (double, ค่าเริ่มต้น 0.0): พิกัดของจุด B (ใช้เมื่อ bMode เป็น "fixture" หรือ "image")
    • bIndex (int, ค่าเริ่มต้น 0): ลำดับของ Blob สำหรับจุด B เมื่อ bMode เป็น "blob" (0 คือ Blob ที่มีพื้นที่ใหญ่ที่สุด; ส่วนจุด A หากใช้โหมด "blob" จะใช้ index 0)
  • Outputs / Metrics:
    • distancePx (double): ระยะทางระหว่างจุด A และ B ในหน่วยพิกเซล
    • ax, ay, bx, by (double): พิกัดจริงของจุด A และ B บนภาพ
    • distanceMm (double, ส่งออกเฉพาะเมื่อ calibration.pxPerMm > 0): ระยะทางในหน่วยมิลลิเมตร
json
{
  "id": "span",
  "type": "measure_distance",
  "enabled": true,
  "params": {
    "aMode": "fixture",
    "ax": 0.0,
    "ay": 0.0,
    "bMode": "blob",
    "bIndex": 0
  },
  "inputs": {
    "pose": "fix",
    "blob": "ring",
    "roi": "ring_roi"
  }
}

2. หลักการทำงานภายในซอฟต์แวร์ ​

อ้างอิงจาก src/tools/measure_distance.cpp:

  1. แปลงจุด ptA และ ptB ให้อยู่ในระบบพิกัดเดียวกัน (Image Coordinates):
    • หากโหมด "blob" และมีการต่อพอร์ต roi ระบบจะอ่านค่า centerX, centerY, width, height, angleDeg จาก roi_rect เพื่อแปลงพิกัดจากภายใน ROI กลับสู่พิกัดภาพจริงก่อนวัดระยะ
  2. คำนวณระยะทางด้วย std::hypot(ptB.x - ptA.x, ptB.y - ptA.y)
  3. สร้าง Overlay เส้นตรงสีเขียวเชื่อมระหว่าง ptA กับ ptB พร้อมกากบาทที่จุดทั้งสอง
  4. หาก ctx.pxPerMm > 0.0 จึงจะส่งออก Metric distanceMm

3. ทฤษฎีเบื้องหลัง (Metrology & Calibration) ​

1) Euclidean Distance ​

ระยะทางเส้นตรงระหว่างจุด A(xA,yA) และ B(xB,yB) ในระนาบ 2 มิติ:

dpx=(xB−xA)2+(yB−yA)2

(ใน C++ ใช้ฟังก์ชัน std::hypot เพื่อป้องกันปัญหา Floating-point overflow/underflow)

2) การแปลงหน่วยพิกเซลเป็นมิลลิเมตร (Spatial Calibration) ​

ใน Phase 1 ใช้การเทียบสเกลแบบเชิงเส้น (Isotropic Pixel Scale) จากค่า calibration.pxPerMm ในไฟล์ Recipe:

dmm=dpxpxPerMm

กฎเหล็กเรื่อง Calibration (pxPerMm == 0)

ตามข้อกำหนดของระบบ หาก pxPerMm == 0 หมายความว่ากล้องยังไม่ได้ Calibrate โมดูลจะไม่ส่งออก distanceMm โดยเด็ดขาด เพื่อป้องกันการรายงานค่ามิลลิเมตรที่ผิดพลาด และหากโมดูล decide มีกฎที่อ้างถึง distanceMm ระบบจะปฏิเสธการโหลด Recipe ทันทีตั้งแต่ตอน Load