Gimbal 1 แกน ใช้ XIAO STM32C5 คุม RollerCAN ผ่าน CAN

CAN do GYRO ทำ Gimbal 1 แกนด้วย XIAO STM32C5 และ CAN Motor

ถ้า IMU รู้ว่ามือของเราหมุนไปทางไหน แล้วสั่ง Brushless Motor ให้หมุนสวนกลับแบบ Real-time จะรักษาทิศทางของวัตถุไว้ได้แค่ไหน?

CAN do GYRO ของ cpietsch เป็นโปรเจกต์ขนาดถือมือได้ที่นำ Seeed Studio XIAO STM32C5 ซึ่งมี IMU และ CAN Transceiver อยู่บนบอร์ด มาควบคุม M5Stack RollerCAN ผ่าน CAN จนกลายเป็น One-Axis Gimbal ที่ติดตาม Orientation ของตัวเองใน 3 มิติ

CAN do GYRO โปรเจกต์ Gimbal แบบหนึ่งแกนที่ใช้ XIAO STM32C5 และ RollerCAN
CAN do GYRO โปรเจกต์ One-Axis Gimbal ที่ Hackaday นำเสนอ ใช้ Motion Sensor และ CAN Motor ทำงานร่วมกันในระบบ Closed Loop
Key Takeaways
  • เป็น One-Axis Gimbal แต่ติดตาม Orientation ของตัวระบบใน 3 มิติ
  • Controller ใช้ Seeed Studio XIAO STM32C5 พร้อม LSM6DS3TR-C IMU
  • Motor ใช้ M5Stack Unit RollerCAN และสั่งผ่าน Classic CAN 1 Mbit/s
  • Gyroscope ใช้ Sample Rate 416 Hz และ Control Loop ทำงานประมาณ 1 kHz
  • มี Auto Calibration, IMU Heater และ Free-spin Protection
  • Firmware ใช้ Zephyr + PlatformIO และ Source Code เปิดบน GitHub ภายใต้ MIT License
  • มี Official Wiring Diagram, Source Code และ Demo Video ให้ศึกษา

มอเตอร์แกนเดียว แต่ติดตามการเคลื่อนไหว 3 มิติได้อย่างไร?

One-axis gimbal ที่ใช้ Brushless Motor และบอร์ดควบคุมขนาดเล็ก
ลักษณะของชุด One-Axis Gimbal ที่ Hackaday แสดงในบทความ โดย Motor สามารถหมุนชดเชยได้หนึ่งแกน

จุดน่าสนใจของโปรเจกต์นี้คือ Motor มีอิสระในการหมุนเพียงแกนเดียว แต่ Controller ไม่ได้ดูเฉพาะการหมุนรอบแกนนั้น XIAO STM32C5 ใช้ข้อมูลจาก IMU เพื่อติดตาม Orientation ของส่วนบนใน 3 มิติ

เมื่อผู้ใช้หมุนฐาน Motor Firmware จะคำนวณว่าด้านหน้าของส่วนบนเบี่ยงจากทิศเดิมไปเท่าใด จากนั้นสั่ง RollerCAN ให้หมุนชดเชยในแกนที่ Motor สามารถควบคุมได้

นี่จึงไม่ใช่แค่ “อ่าน Gyro แกนหนึ่งแล้วหมุน Motor สวน” แต่เป็นการติดตาม Orientation ของตัว Controller แล้วคำนวณ Correction เฉพาะแกนที่ Motor สามารถสร้างการเคลื่อนไหวได้

Hardware ของ CAN do GYRO มีอะไรบ้าง?

CAN do GYRO ที่ประกอบด้วย RollerCAN แบตเตอรี่และ XIAO STM32C5
ภาพ Hardware จริงจาก Official GitHub เห็น RollerCAN อยู่ด้านล่าง พร้อม Battery และ XIAO STM32C5 บนส่วนที่ต้องรักษาทิศทาง
อุปกรณ์ หน้าที่ในโปรเจกต์
Seeed Studio XIAO STM32C5 อ่าน IMU, คำนวณ Orientation และ Control Loop แล้วสื่อสารผ่าน CAN
LSM6DS3TR-C 6-axis IMU สำหรับ Accelerometer และ Gyroscope
M5Stack Unit RollerCAN BLDC Motor พร้อม FOC Driver, Encoder, CAN Interface และ OLED
2S LiHV Battery ตัวอย่างของผู้สร้างใช้ 580 mAh, 7.6V nominal
DuPont Pigtails เชื่อม CANH, CANL และ Power ระหว่าง Controller กับ Motor

XIAO STM32C5

XIAO STM32C5 ใช้ STM32C5A3CG ซึ่งเป็น Arm Cortex-M33 ทำงานสูงสุดที่ 144 MHz พร้อม FPU และมี LSM6DS3TR-C IMU รวมถึง CAN Transceiver บนบอร์ด

Official Seeed Documentation ระบุว่า Board มี 1 MB Internal Program Flash และ 16 MB External Flash โดยโปรเจกต์ CAN do GYRO ใช้ Internal Dual-bank Flash ส่วนหนึ่งสำหรับบันทึก Telemetry

M5Stack Unit RollerCAN

RollerCAN เป็น BLDC Motor Unit ที่รวม Motor, FOC Driver, Magnetic Encoder, CAN Interface และ OLED ไว้ในโมดูลเดียว

ในโปรเจกต์นี้ RollerCAN สื่อสารด้วย Classic CAN 2.0 ที่ 1 Mbit/s แม้ XIAO STM32C5 เองจะมี Controller ที่รองรับ CAN FD ก็ตาม

Wiring ระหว่าง XIAO STM32C5 และ RollerCAN

Wiring diagram เชื่อม XIAO STM32C5, RollerCAN และแบตเตอรี่
Official Wiring Diagram จาก CAN do GYRO Repository แสดง Battery, CANH/CANL และ Power ระหว่าง RollerCAN กับ XIAO

RollerCAN ใช้ XT30 แบบ 2+2 สำหรับ Power และ CAN ส่วน XIAO เชื่อม CANH / CANL ไปยัง CAN_H / CAN_L ของ Motor และรับ 5V/GND จาก Grove Port ของ RollerCAN

  • Battery ต่อเข้าขั้ว Power ของ RollerCAN
  • XIAO CANH ต่อ CAN_H
  • XIAO CANL ต่อ CAN_L
  • 5V และ GND จาก Grove Port ใช้เลี้ยง XIAO ตอน Standalone
Wiring ด้านบนอ้างอิง Diagram ของผู้สร้างโดยตรง ไม่ควรเปลี่ยน Pinout หรือ Battery Connection จากการคาดเดา และควรตรวจ Polarity ทุกครั้งก่อนจ่ายไฟ

Orientation Tracking ทำงานอย่างไร?

Firmware ใช้ Gyroscope ทั้งสามแกน เพื่อ Integrate Orientation เป็น Quaternion และใช้ข้อมูลจาก Accelerometer ช่วยดึง Tilt กลับเข้าหาทิศ Gravity เมื่อค่าความเร่งอยู่ใกล้ประมาณ 1 g

Accelerometer ไม่สามารถบอก Heading ได้โดยตรง ดังนั้น Heading ยังอาศัย Gyroscope เป็นหลัก ขณะที่ Gravity ช่วย Stabilize ส่วน Tilt

ผู้สร้างอธิบายว่าการดูเฉพาะ Gyro รอบแกน Motor ไม่เพียงพอ เพราะการเอียง หมุน แล้วเอียงกลับ สามารถทำให้ Orientation เปลี่ยนแบบที่ Single-axis Counter มองไม่เห็น

Control Loop คุม Motor ผ่าน CAN อย่างไร?

XIAO อยู่บนส่วนที่ต้องรักษาทิศทาง จึงสามารถวัด Correction ของตัวเองได้โดยตรง จากนั้น Control Loop จะคำนวณ Target Position ใหม่ให้ Rotor และส่งคำสั่งไปยัง RollerCAN ผ่าน CAN

Official README ระบุว่า Loop ทำงานประมาณ 1 kHz ขณะที่ Gyroscope ทำงานที่ 416 Hz และ Firmware ใช้ทุก Sample จาก IMU FIFO

RollerCAN ใช้ Position Controller ภายในของตัวเอง ส่วน Firmware ฝั่ง XIAO คำนวณ Target จาก Deviation, Turning Rate, Damping และ Integral Correction

แนวคิดจึงแบ่งงานเป็นสองระดับ: XIAO คิดว่า “ควรหมุนไปตำแหน่งไหน” ส่วน RollerCAN รับผิดชอบการขับ BLDC ให้ไปถึงตำแหน่งนั้น

Auto Calibration และ Free-spin Protection

ตอนเปิดเครื่อง ผู้สร้างกำหนดให้วางชุดตั้งตรงและอยู่นิ่งประมาณ 2 วินาที เพื่อวัด Gyro Offset และ Motor Axis ถ้าระบบตรวจว่ามีการเคลื่อนไหวระหว่างช่วงนี้จะเริ่ม Calibration ใหม่

อีก Feature สำคัญคือ Free-spin Protection เพราะถ้าถือส่วนบนของชุดไว้กลางอากาศ ด้านล่างไม่มีพื้นให้ Motor ผลักกลับ Rotor จึงสามารถเร่งความเร็วขึ้นได้มาก

Firmware จะสั่ง Motor Off หากตรวจว่า Rotor หมุนเกิน 180° ภายใน 0.2 วินาที และจะกลับเข้าสู่ Hold หลังจากชุดอยู่นิ่งตามเงื่อนไขที่ Firmware กำหนด

ทำไมโปรเจกต์นี้ต้องใช้ IMU Heater?

Gyroscope Bias สามารถเปลี่ยนตามอุณหภูมิ และ XIAO STM32C5 มี Heating Resistor อยู่รอบ IMU จึงสามารถควบคุมอุณหภูมิด้วย Firmware ได้

CAN do GYRO ตั้งเป้า IMU ไว้ที่ประมาณ 40°C และใช้ PI Regulation จาก Temperature Sensor ภายใน IMU เพื่อควบคุม Heater ผ่าน PWM

Source ระบุว่า Heater จะถูกปิดเมื่ออุณหภูมิสูงกว่า 50°C หรืออ่านค่า Temperature ไม่ได้

Firmware ใช้ Zephyr และ PlatformIO

ผู้สร้างระบุว่าในช่วงที่ทำโปรเจกต์ STM32C5 ยังไม่มี Arduino Core ที่ใช้กับงานนี้ จึงพัฒนาเป็น Zephyr Application และ Build ผ่าน PlatformIO

Build and Upload จาก Official README
pio run -e xiao -t upload
เปิด Serial Monitor
pio device monitor

Upload Process ใช้ UF2 Bootloader ของ XIAO โดย Repository มี PlatformIO Configuration และ Zephyr Configuration ที่ผู้สร้างใช้กับ Project จริงให้ดาวน์โหลดครบ

บันทึก Telemetry ลง Flash ได้ประมาณ 90 วินาที

Project สามารถ Record Telemetry ระหว่างทำงานแบบ Standalone โดยเก็บข้อมูลลงพื้นที่ Internal Flash ที่ผู้สร้างใช้เป็น Recording Area

Source ระบุว่าพื้นที่ประมาณ 480 KB สามารถเก็บข้อมูลได้ประมาณ 90 วินาที แล้วหยุด Recording เมื่อพื้นที่เต็ม

ข้อมูลประกอบด้วยเวลา, Turning Rate, Deviation, Rotor Position, Motor Current, Tilt และ Flags ของระบบ

Export Recording เป็น CSV
python log.py rec.csv

ดู CAN do GYRO ทำงานจริง

Official Demo Video ที่ลิงก์โดยตรงจาก CAN do GYRO GitHub README

เปิด Demo Video บน YouTube

Source Code และ Download Files

Official Repository ไม่มี GitHub Release Binary, Firmware Package, STL, STEP หรือ Gerber แยกต่างหาก ดังนั้นไฟล์ด้านล่างคือ Source และ Configuration ที่เกี่ยวข้องกับ Project โดยตรง

ดาวน์โหลด Project

Firmware และ Build Files

Telemetry และ Media Files

Official Hardware Documentation

Repository ที่ตรวจสอบไม่มี GitHub Releases จึงไม่มี Firmware Binary หรือ Release Asset ที่ต้องดาวน์โหลดเพิ่ม หากต้องการ Build Project ให้ใช้ Source และ PlatformIO Configuration จาก Repository

Known Issues ที่ผู้สร้างระบุไว้

Source ไม่ได้ซ่อนข้อจำกัดของ Project และมี Known Issues ที่ควรอ่านก่อนนำแนวคิดไปต่อยอด

  • เมื่อทำงานด้วย Battery โดยไม่มี USB ผู้สร้างพบว่า Gyro Noise สูงขึ้น ทำให้ Standing-still Correction เกิดน้อยลง และส่วนบนค่อย ๆ Drift
  • Source ระบุว่าบน USB + Battery Prototype ของผู้สร้าง Hold ได้ภายในประมาณ 0.4° ต่อนาที แต่ตัวเลขนี้เป็นผลของ Prototype ชุดนี้ ไม่ใช่ Accuracy Specification ทั่วไป
  • การทำ Loop ให้เร็วกว่าประมาณ 1 ms ในการทดลองของผู้สร้าง ทำให้ Tilt Estimate ผิดและ Motor Runaway โดยยังไม่ทราบสาเหตุแน่ชัด

Safety ก่อนทดลองกับ Motor และ Battery

Motor สามารถหมุนเร็วได้: หากถือส่วนบนไว้ในอากาศ Rotor ด้านล่างไม่มีสิ่งให้ผลักกลับ และสามารถเร่งความเร็วได้ ควรเก็บสายและนิ้วมือให้พ้นส่วนหมุน
RollerCAN ไม่มี Timeout สำหรับ Last Target ตามที่ผู้สร้างระบุ: ถ้า XIAO หยุดส่งคำสั่ง เช่น Reset หรือถูกถอดออก Motor Controller อาจยังคง Target ล่าสุดไว้
ตรวจแรงดันก่อนจ่ายไฟ: Official RollerCAN ระบุช่วง Supply ผ่าน Power/CAN เป็น 6–16V และ Source เตือนว่า Supply ต้องไม่เกิน 16V
Battery: Project ใช้ LiHV/LiPo Battery ควรใช้ Battery และ Charger ที่เหมาะสม ตรวจ Polarity และหลีกเลี่ยงการลัดวงจร บทความนี้ไม่เพิ่ม Battery Wiring หรือ Protection Circuit ที่ Source ไม่ได้ระบุ

โปรเจกต์นี้ราคาเท่าไร?

Main Source ของ Hackaday ไม่ได้ระบุราคาของ Project และ Official CAN do GYRO Repository ก็ไม่ได้ระบุ BOM Cost รวม ดังนั้นบทความนี้ไม่สร้างราคาประมาณขึ้นเอง และไม่มีราคาจากบทความต้นฉบับที่ต้องแปลงเป็นเงินบาท ณ วันที่เผยแพร่บทความนี้

FAQ คำถามที่พบบ่อย

CAN do GYRO คืออะไร?

เป็น One-Axis Gimbal ที่ใช้ XIAO STM32C5 อ่าน Orientation และสั่ง RollerCAN ผ่าน CAN เพื่อหมุนชดเชยการเคลื่อนไหว

ทำไม Motor มีหนึ่งแกนแต่ระบบติดตาม 3 มิติ?

เพราะ IMU และ Firmware ติดตาม Orientation ของ Controller ใน 3 มิติ แล้วคำนวณ Correction เฉพาะรอบแกนที่ Motor สามารถหมุนได้

ใช้ Microcontroller อะไร?

ใช้ Seeed Studio XIAO STM32C5 ที่ใช้ STM32C5A3CG Arm Cortex-M33 ทำงานสูงสุด 144 MHz

IMU รุ่นอะไร?

XIAO STM32C5 มี LSM6DS3TR-C 6-axis IMU บนบอร์ด

Motor รุ่นอะไร?

Prototype ใช้ M5Stack Unit RollerCAN ซึ่งเป็น BLDC Motor Unit พร้อม Controller, Encoder, CAN และ OLED

ใช้ CAN FD หรือไม่?

XIAO STM32C5 รองรับ CAN FD แต่ Project นี้ใช้ Classic CAN 2.0 ที่ 1 Mbit/s กับ RollerCAN

Control Loop เร็วเท่าไร?

Official Project README ระบุว่า Closed-loop ทำงานประมาณ 1 kHz และ Gyroscope ทำงานที่ 416 Hz

ใช้ Arduino IDE ได้หรือไม่?

Source ของ Project นี้ใช้ Zephyr และ PlatformIO ไม่ได้สร้าง Firmware ด้วย Arduino Framework

มี Auto Calibration หรือไม่?

มี โดยตอนเริ่มต้นชุดต้องอยู่นิ่งประมาณ 2 วินาที เพื่อวัด Gyro Offset และ Motor Axis

มีระบบป้องกัน Motor หมุนฟรีหรือไม่?

มี Firmware จะปิด Motor หาก Rotor หมุนเกิน 180° ภายในช่วง 0.2 วินาทีตาม Logic ของ Project

บันทึก Telemetry ได้หรือไม่?

ได้ Source ระบุว่าบันทึกลง Internal Flash ได้ประมาณ 90 วินาที และใช้ log.py Export เป็น CSV

มีไฟล์ STL หรือ Enclosure หรือไม่?

Source ไม่ได้ให้ STL, STEP หรือ CAD Enclosure สำหรับ Project นี้

มี Firmware Binary สำเร็จรูปให้ดาวน์โหลดหรือไม่?

Repository ที่ตรวจสอบไม่มี GitHub Release และไม่มี Firmware Binary แยก ผู้ใช้ต้อง Build จาก Source ตาม Workflow ของ Project

Battery ใช้งานได้นานแค่ไหน?

Source ไม่ได้ระบุ Battery Runtime จึงไม่สามารถคำนวณหรือประมาณเวลาใช้งานได้อย่างน่าเชื่อถือ

Prototype นี้รับน้ำหนักได้เท่าไร?

Source ไม่ได้ระบุ Payload Rating ของ CAN do GYRO ที่ประกอบเสร็จแล้ว

โปรเจกต์นี้มีราคาเท่าไร?

Hackaday และ Official Project Repository ไม่ได้ระบุราคาหรือ BOM Cost รวม

โปรเจกต์นี้มีหลายขั้น แนะนำอ่านต้นฉบับควบคู่กัน

งานนี้มีทั้ง IMU Calibration, CAN Communication, Motor Control, Zephyr Configuration และ Battery Safety หากต้องการสร้างตามควรเปิด README และ Source Code ของผู้สร้างควบคู่กับบทความนี้

References / แหล่งข้อมูลต้นฉบับ

อยากทดลองทำ Motion Control หรือ CAN Project?

โปรเจกต์แบบนี้ช่วยให้เห็นภาพการทำงานร่วมกันระหว่าง Microcontroller, IMU, CAN Bus และ Motor Control ได้ชัดมาก หากกำลังเริ่ม Project ด้าน Embedded, Robotics หรือ Motion Control สามารถสอบถามทีม Globalbyte เรื่องบอร์ด, Sensor, Module และอุปกรณ์ Maker ที่เหมาะกับงานได้

Disclaimer: บทความนี้เป็นการสรุปและเรียบเรียงจากแหล่งข้อมูลภาษาอังกฤษ อาจมีความคลาดเคลื่อน กรุณาตรวจสอบ Source ต้นฉบับก่อนลงมือทำ โปรเจกต์นี้เกี่ยวข้องกับ BLDC Motor, CAN Bus และ LiHV/LiPo Battery ซึ่งอาจเกิดการหมุนอย่างรวดเร็วหรือความเสียหายจากการต่อ Power ผิดได้ ให้ตรวจ Wiring, Polarity, Supply Voltage และข้อจำกัดของ Hardware จากเอกสารผู้ผลิตก่อนทดลองจริง Performance, Drift, Loop Timing และค่าที่กล่าวถึงในบทความ เป็นข้อมูลของ Prototype / Source ที่อ้างอิง ไม่ควรตีความเป็น Specification สำหรับ Hardware Configuration อื่น Source ไม่ได้ระบุ Payload Rating, Battery Runtime หรือ BOM Cost รวม และ Repository ไม่มี STL, STEP, Gerber หรือ Firmware Release Binary นอกจากนี้รูปภาพจาก Hackaday และแหล่งภายนอกยังอยู่ภายใต้สิทธิ์ของเจ้าของต้นฉบับ ควรตรวจสิทธิ์การนำภาพมาใช้ก่อนเผยแพร่เชิงพาณิชย์

แท็ก


Blog posts