จลนศาสตร์ของแขนหุ่นยนต์: จากมุมข้อต่อสู่ตำแหน่ง

ข้อต่อ ลิงก์ และจุดเครื่องมือ

แยกแขนหุ่นยนต์ออกเป็นชิ้นส่วนพื้นฐาน แล้วคุณจะพบชิ้นส่วนอยู่สองประเภท:

• ข้อต่อ ซึ่งหมุน (หรือบางครั้งเลื่อน) และขับเคลื่อนด้วยมอเตอร์
• ลิงก์ ส่วนที่แข็งเกร็งระหว่างข้อต่อ ซึ่งไม่เคยเปลี่ยนความยาว

ที่ปลายอิสระมี จุดเครื่องมือ อยู่ ซึ่งเป็นจุดที่อาจติดตั้งคีมจับ ปากกา หรือหัวเชื่อม คำถามที่จลนศาสตร์ไปข้างหน้าตอบคือ: เมื่อรู้มุมของข้อต่อทุกตัวแล้ว จุดเครื่องมืออยู่ที่ไหน?

คำถามย้อนกลับ ซึ่งก็คือการหามุมข้อต่อที่ทำให้ไปถึงจุดที่เลือกไว้ เรียกว่าจลนศาสตร์ผกผัน ซึ่งยากกว่า และเราจะกลับมาพูดถึงเรื่องนี้ใกล้จบบท เริ่มจากทิศทางไปข้างหน้าก่อน เพราะนี่คือเรขาคณิตล้วน ๆ และมีคำตอบเดียวทุกครั้ง

แขนสองลิงก์แบบราบกับตรีโกณมิติเล็กน้อย

เริ่มจากพิจารณาแขนกลสองท่อนที่เคลื่อนที่อยู่ในระนาบราบเดียวกัน เรียกความยาวของท่อนแขนว่า L1 และ L2 โดยวัด มุมไหล่ θ1 จากแนวระดับ และวัด มุมข้อศอก θ2 สัมพัทธ์กับท่อนแขนท่อนแรก ไม่ใช่กับพื้น

ตำแหน่งปลายเครื่องมือคำนวณได้จากการบวกเวกเตอร์สองตัว ตัวละหนึ่งท่อนแขน:

x = L1 cos θ1 + L2 cos(θ1 + θ2)

y = L1 sin θ1 + L2 sin(θ1 + θ2)

พจน์แรกในแต่ละบรรทัดคือ ตำแหน่งของข้อศอก พจน์ที่สองคือระยะชดเชยเพิ่มเติมจากข้อศอกไปยังปลายเครื่องมือ สังเกตว่าท่อนแขนท่อนที่สองชี้ไปในทิศทาง θ1 + θ2 เพราะวัดมุมข้อศอกจากท่อนแขนท่อนแรก การลืมการบวกนี้เป็นข้อผิดพลาดที่พบบ่อยที่สุด

เนื่องจากท่อนแขนทุกท่อนแข็ง จึงไม่มีสิ่งอื่นที่ต้องคำนึงถึง หากใส่มุมเดิมซ้ำสองครั้ง ก็จะได้ตำแหน่งเดิมทุกครั้ง

การหันเห: หมุนทั้งระนาบ

แขนจริงไม่ได้จำกัดการเคลื่อนที่อยู่แค่ในระนาบเดียว ข้อต่อฐานที่เรียกว่า การหันเห จะหมุนแขนทั้งชุดรอบแกนแนวดิ่ง ลองนึกถึงโคมไฟตั้งโต๊ะที่หมุนได้บนฐาน

การหันเหไม่เปลี่ยนสองสิ่งนี้: ความยาวของลิงก์แต่ละชิ้น และความสูงของเครื่องมือเหนือฐาน สิ่งที่มันทำมีเพียงหมุนระนาบการทำงาน ทำให้ระยะเอื้อมในแนวระดับชี้ไปในทิศทางใหม่ หากแขนแบนเอื้อมออกจากฐานเป็นระยะทาง r การหันเหเป็นมุม ψ จะทำให้เครื่องมืออยู่ที่

horizontal position = (r cos ψ, r sin ψ)

ขณะที่ความสูงยังคงเท่าเดิม วิธีนี้แบ่งปัญหาสามมิติออกเป็นปัญหาแขนสองมิติรวมกับการหมุน จึงเป็นเหตุผลที่แขนอุตสาหกรรมจำนวนมากสร้างขึ้นในลักษณะนี้

แขนเอื้อมได้ไกลแค่ไหน?

ระยะเอื้อมของแขนถูกจำกัดด้วยลิงก์ของมัน เครื่องมือจะอยู่ห่างจากไหล่ได้ไกลที่สุดเมื่อ ลิงก์ทั้งสองชิ้นเรียงเป็นเส้นตรง: L1 + L2 สำหรับลิงก์ที่มีความยาว 1.65 m และ 1.25 m จะได้ระยะ 2.90 m

ระยะที่ใกล้ที่สุดคือเมื่อข้อศอกพับกลับจนสุด: |L1 − L2| ซึ่งในกรณีนี้คือ 0.40 m ระหว่างขอบเขตทั้งสอง เครื่องมือจะเอื้อมไปถึงบริเวณรูปวงแหวนรอบไหล่ได้ ทุกจุดที่อยู่นอกวงแหวนนี้เอื้อมไม่ถึง ไม่ว่าตัวควบคุมจะฉลาดแค่ไหน

พื้นที่ทำงาน นี้เป็นหนึ่งในสิ่งแรก ๆ ที่วิศวกรตรวจสอบเมื่อเลือกแขนกล เป้าหมายที่ดูเหมือนอยู่ใกล้ฐานอาจยังเอื้อมไม่ถึง หากเป้าหมายนั้นอยู่ภายในวงกลมด้านใน

ทำไมเป้าหมายหนึ่งจุดจึงมีคำตอบได้สองแบบ หรือไม่มีคำตอบเลย

ลองคำนวณย้อนกลับ แล้วจะพบสิ่งที่น่าสนใจ โดยปกติเมื่อเลือกจุดที่แขนกลเอื้อมถึง จะมี สองวิธี ที่ไปถึงจุดนั้นได้: ข้อศอกอาจงอไปทางหนึ่ง (มักเรียกว่าแขนยกข้อศอกขึ้น) หรืออีกทางหนึ่ง (แขนกดข้อศอกลง) ทั้งสองวิธีทำให้ปลายเครื่องมืออยู่ในตำแหน่งเดียวกันพอดี

มี 3 กรณี:

• มีคำตอบสองแบบ เมื่อจุดนั้นอยู่ด้านในวงแหวนที่แขนกลเอื้อมถึงอย่างชัดเจน
• มีคำตอบแบบเดียว เมื่อจุดนั้นอยู่ตรงขอบพอดี โดยแขนเหยียดสุดหรืองอพับสุด
• ไม่มีคำตอบ เมื่อจุดนั้นอยู่นอกวงแหวน

นี่คือเหตุผลที่จลนศาสตร์ผกผันซับซ้อนกว่าจลนศาสตร์ไปข้างหน้า การคำนวณไปข้างหน้าให้คำตอบเดียวเสมอ ส่วนการคำนวณย้อนกลับอาจให้คำตอบสองแบบ แบบเดียว หรือไม่มีคำตอบเลย และตัวควบคุมต้องเลือกอย่างเหมาะสม เช่น หลีกเลี่ยงการชนกับโต๊ะ

ความเข้าใจผิดที่พบบ่อย

• "มุมข้อศอกวัดจากพื้น" ในรูปแบบนี้ มุมดังกล่าววัดสัมพัทธ์กับข้อต่อแรก ดังนั้นทิศทางของข้อต่อที่สองจึงเป็นผลรวมของมุมทั้งสอง
• "มุมข้อต่อที่ใหญ่ขึ้นหมายถึงเอื้อมได้ไกลขึ้นเสมอ" ระยะเอื้อมขึ้นอยู่กับว่าแขนเหยียดตรงแค่ไหน ไม่ใช่หมุนไปมากแค่ไหน
• "ถ้าจุดอยู่ใกล้ ก็เอื้อมถึงได้" ถ้าอยู่ภายในวงกลมระยะเอื้อมขั้นต่ำ ก็เอื้อมไม่ถึง
• "การหันเหเปลี่ยนความสูง" ไม่ใช่เลย การหันเหเพียงหมุนแขนรอบแนวดิ่งเท่านั้น

วิธีสำรวจเรื่องนี้ในห้องทดลอง

The Robot Arm Lab gives you sliders for yaw, shoulder and elbow and shows the tool point moving in 3D. The free first world has two lessons, and they fit this guide in order:

1. The robot’s coordinate system sets up the axes, the angle conventions and the two link lengths, and lets you find the arm’s maximum reach.
2. Turn a plane through space shows what the base joint does and does not change.

After those, try to hit a target by hand and notice how often a second arm pose also works. Later worlds in the lab extend this to solving target positions directly.

The lab is a simplified teaching model: perfectly rigid links, no motor limits, no gravity sag. Real robots add all of those, but the geometry you learn here is the core.