- CARA เป็นสุนัขหุ่นยนต์ความแม่นยำสูงที่ใช้ กลไกเชือก ซึ่งแตกต่างจากวิธีแบบเดิม
- เพื่อ ปรับเทียบตำแหน่งเริ่มต้น แต่ละข้อต่อจะผ่านกระบวนการโฮมมิงโดย ตรวจจับการเปลี่ยนแปลงของกระแสไฟฟ้า เพื่อหาขีดจำกัดทางกายภาพ
- ควบคุมตำแหน่งและท่าทางของขาได้อย่างแม่นยำผ่านสมการ 3 ชนิด ได้แก่ Inverse Kinematics (IK), Forward Kinematics (FK), Rotational Kinematics (RK)
- ใช้ แพทเทิร์นการเดินที่อิงตามวิถีไซโคลิด เพื่อให้การเคลื่อนที่เป็นธรรมชาติและการเคลื่อนไหวที่นุ่มนวล
- รองรับการเคลื่อนไหวหลากหลาย เช่น ทิศทางการเดินและการหมุน ด้วย trot gait ที่ให้ขาคู่ทแยงเคลื่อนที่พร้อมกัน
การเขียนโปรแกรม
ลำดับโฮมมิง (Homing sequence)
- ขั้นตอนแรกของการเขียนโปรแกรม CARA คือการพัฒนา ลำดับการโฮมมิงข้อต่อ (การปรับตำแหน่งอัตโนมัติ)
- ในการโฮมมิง สามารถวัดได้เพียงตำแหน่งสัมพัทธ์ของข้อต่อโดยอาศัย absolute position encoder ของเพลามอเตอร์แต่ละข้อต่อเท่านั้น
- เมื่อเริ่มทำงาน จะ หมุนข้อต่อไปจนถึงขีดจำกัดทางกายภาพ และตรวจจับการถึงจุดดังกล่าวจาก กระแสไฟฟ้าที่เพิ่มขึ้น
- หลังจากถึงขีดจำกัดทางกายภาพแล้ว จะสามารถ กำหนดตำแหน่งสัมบูรณ์ของข้อต่อ ได้
- กระบวนการนี้ต้อง รันหนึ่งครั้งทุกครั้งที่เริ่มระบบ
คิเนแมติกส์ (Kinematics)
- เพื่อควบคุมการเคลื่อนไหวของลำตัว ใช้สมการทั้งหมด 3 ชนิด ได้แก่ Inverse Kinematics (IK), Forward Kinematics (FK), Rotational Kinematics (RK)
- สมการ IK: คำนวณ มุมของข้อต่อเพื่อวางขา (ปลายเท้าหรือ end effector) ไปยังตำแหน่ง X, Y, Z ที่ต้องการ
- สมการ FK: รับ มุมข้อต่อปัจจุบันเป็นอินพุต แล้วคำนวณตำแหน่ง X, Y, Z ของเท้า
- ในการวางแผนวิถี จะคำนวณตำแหน่งปัจจุบันด้วย FK ก่อน จากนั้นทำ การคำนวณ waypoint ระหว่างทาง ไปยังจุดเป้าหมาย (ใช้ Arduino RAMP library) และคำนวณมุมข้อต่อด้วย IK สำหรับแต่ละ waypoint
- สมการ RK: ใช้คำนวณ ตำแหน่งของเท้าที่จำเป็นต่อการหมุนของลำตัวตามแกน roll, pitch, yaw
- ใช้ตำแหน่งเท้าที่คำนวณจาก RK ไปหามุมอีกครั้งด้วย IK
- นำไปใช้กับ การควบคุมท่าทาง (pose control) และการรักษาเสถียรภาพ ช่วยให้หุ่นยนต์หมุนลำตัวอยู่กับที่หรือทรงตัวได้ดีขึ้น
การเดิน (Gait)
- การเดินของ CARA ใช้ trajectory ของสเต็ปที่อิงตาม วิถีไซโคลิด เพื่อให้ได้ การเคลื่อนไหวที่นุ่มนวลและสมจริง
- มีการทดลองวิถีสเต็ปแบบสามเหลี่ยมและสี่เหลี่ยมด้วย แต่ด้อยกว่าในด้าน ความนุ่มนวล การหลบหลีกสิ่งกีดขวางของขา และความเป็นธรรมชาติของการเคลื่อนไหว
- รูปแบบการเดินหลักคือ trot gait (ขาคู่ทแยงเคลื่อนที่พร้อมกัน) โดยการเคลื่อนไหวประกอบด้วย swing phase (เคลื่อนไปข้างหน้าในอากาศ) และ stance phase (ดันถอยหลังบนพื้น)
- ระหว่างการเดิน จะสลับ swing phase และ stance phase ระหว่างคู่ขาทแยงซ้ำไปมาเพื่อสร้าง การก้าวเดินอย่างต่อเนื่อง
- สำหรับการเดินในทิศทางอื่นนอกเหนือจากเดินหน้าและถอยหลัง จะคงแพทเทิร์น trot ไว้แต่เปลี่ยนเพียงมุมของสเต็ปขา
- ขณะหมุน ขาคู่หนึ่งจะก้าวออกด้านนอก และอีกคู่จะก้าวเข้าด้านใน ทำให้สามารถ หมุนเป็นเส้นโค้งหรือหมุนอยู่กับที่ ได้
1 ความคิดเห็น
ความคิดเห็นจาก Hacker News
https://www.aaedmusa.com/