Drone 5 นิ้วตัวนี้บินด้วย STM32 Flight Controller ที่เขียนเอง

ปกติการทำ FPV Quadcopter สักตัว เราอาจเริ่มจาก Flight Controller สำเร็จรูป แล้วใช้ Betaflight หรือ INAV จัดการ Sensor Fusion, PID และ Motor Output ให้

แต่โปรเจกต์ No Fly Zone ของ Maker tynix5 เลือกอีกทาง: ออกแบบ Flight Controller PCB, Remote PCB และเขียน Firmware เอง ตั้งแต่การอ่าน IMU ไปจนถึง DShot และ Wireless Link

No Fly Zone DIY quadcopter พร้อม custom STM32 flight controller
No Fly Zone เป็น Quadcopter 5 นิ้ว ที่ใช้ Flight Controller และ Remote PCB ซึ่งผู้สร้างออกแบบและเขียน Firmware เอง
Key Takeaways
  • Flight Controller ใช้ STM32F446RCT
  • IMU คือ LSM6DS3TR และมี LPS25HB Barometer
  • ใช้ Madgwick Filter สำหรับ Sensor Fusion
  • ส่ง Motor Command ผ่าน DShot ที่สร้างด้วย Timer + DMA
  • Flight Controller และ Remote สื่อสารผ่าน nRF24L01
  • Remote ใช้ STM32L432KC พร้อม SSD1306 OLED
  • PCB Flight Controller พัฒนาผ่าน Rev 1.0, 2.0 และ 2.1
  • Repository มี Firmware, KiCad, Gerber, BOM และ Fusion 360 CAD

No Fly Zone คืออะไร?

No Fly Zone quadcopter ประกอบเสร็จแล้ว
Quadcopter ที่ประกอบเสร็จแล้วจาก Repository ของผู้สร้าง

Project นี้เริ่มจากความตั้งใจที่จะสร้างระบบควบคุม Drone โดยไม่ซื้อ Flight Controller และ Remote สำเร็จรูป

ส่วนที่ผู้สร้างทำเองประกอบด้วย Flight Controller PCB, Remote PCB, Sensor Fusion, Wireless Driver, DShot Implementation, OLED Interface และ Remote Housing

ส่วน ESC, BLDC Motors, Frame, Propellers และ Battery เป็น Hardware สำเร็จรูป

No Fly Zone quadcopter มุมบนภาพที่ 1
ภาพประกอบตัว Quadcopter จาก GitHub
No Fly Zone quadcopter มุมบนภาพที่ 2
มุมเพิ่มเติมของตัว Drone และ Electronics Stack
Flight controller และ ESC บน No Fly Zone quadcopter
Flight Controller โดยมี ESC ติดตั้งอยู่ด้านล่าง
No Fly Zone quadcopter ภาพประกอบเพิ่มเติม
ภาพประกอบ Assembly ของ Quadcopter
No Fly Zone quadcopter พร้อม flight controller
อีกมุมของ Flight Controller ที่ติดตั้งบน Frame

ระบบ Flight Controller ทำงานอย่างไร?

Software flow diagram ของ No Fly Zone flight controller
Block Diagram จากผู้สร้าง แสดง Flow ระหว่าง Sensor, RF, Attitude Control และ Motor Output

Firmware README สรุปหน้าที่หลักของ Flight Controller ไว้ 5 ส่วน:

  1. อ่านข้อมูลจาก IMU และ Barometer
  2. รับ Control Packet จาก nRF24L01
  3. คำนวณ Orientation จาก Sensor Data
  4. คำนวณ Motor Command เพื่อให้ได้ Desired Orientation
  5. Monitor Battery Level

Flight Controller ใช้ STM32F446RCT

Custom STM32F446 flight controller PCB ของ No Fly Zone
Custom Flight Controller PCB ที่ใช้ STM32F446RCT เป็น MCU หลัก

ผู้สร้างเลือก STM32F446RCT เพราะ Maximum Clock Speed, Hardware FPU สำหรับ Quaternion Calculation และจำนวน SPI / Timer Peripheral ที่เพียงพอ

ส่วน Hardware / Function
MCU STM32F446RCT
IMU LSM6DS3TR
Barometer LPS25HB
RF nRF24L01
ESC Interface DShot
Battery Monitoring ADC Battery Voltage + ESC Current Sense
Flight controller PCB ภาพจริงด้านหน้า
ภาพจริงของ Flight Controller PCB
Flight controller PCB ภาพจริงเพิ่มเติม
ภาพเพิ่มเติมของ PCB และ Components
ด้านหลังของ custom flight controller PCB
ด้านหลังของ Flight Controller PCB
KiCad render ของ flight controller PCB รุ่นแรก
PCB Render จากไฟล์ออกแบบใน Repository

Madgwick Filter เปลี่ยน IMU Data ให้เป็น Orientation

LSM6DS3TR ส่งข้อมูล IMU ผ่าน SPI และ Firmware ใช้ Madgwick Filter เพื่อประเมิน Orientation ของ Drone

Current Orientation จะถูกนำไปเทียบกับ Desired Orientation ที่ Remote ส่งเข้ามา แล้ว Control Loop คำนวณ Rate Error สำหรับสั่ง Motor ต่อไป

LPS25HB Barometer มีอยู่บน Board แต่ Firmware README ระบุว่าปัจจุบันยังไม่ได้ใช้สำหรับ Altitude Hold ดังนั้น Project เวอร์ชันนี้ยังไม่ควรถูกอธิบายว่ามี Altitude Hold แล้ว

DShot ถูกสร้างด้วย Timer + DMA

STM32 ไม่ได้ขับ Phase ของ BLDC Motor โดยตรง แต่สร้าง DShot Digital Command แล้วส่งให้ Commercial 4-in-1 ESC

ผู้สร้างใช้ STM32 Timers ร่วมกับ DMA เพื่อสร้าง Bitstream ของ DShot

Flow จริงคือ: Flight Controller → DShot → 4-in-1 ESC → BLDC Motors

PCB ผ่าน Rev 1.0 → 2.0 → 2.1

Flight controller PCB revision 1.0 2.0 และ 2.1
PCB ทั้งสาม Revision จากซ้ายไปขวา: Revision 1.0, 2.0 และ 2.1

Revision 1.0

MCU และ Sensors ถูกแยกเป็นสอง Board และเชื่อมกันด้วย Connector โดยยังมี IMU, Magnetometer, Barometer และ GPS

ปัญหาที่พบคือ JST Connection ไม่เหมาะกับ Environment ที่มี Noise และ Magnetometer ได้รับผลกระทบจาก EMF ของ Motors, PCB Traces และ Components ใกล้เคียง

Revision 2.0

Sensor Board และ MCU ถูกยุบรวมเป็น Board เดียว พร้อมตัด Magnetometer และ GPS ปรับ RF Shielding และเปลี่ยน Layer Stackup เพื่อลด Buck Converter / RF Noise

Revision 2.1

PCB ถูกลดขนาดจาก 50 × 50 mm เป็น 40 × 40 mm และปรับ Footprint / Protection / Debug Connector เพิ่มเติม

No Fly Zone flight controller revision 1 PCB
Revision 1.0 PCB
No Fly Zone flight controller revision 2 PCB
Revision 2.0 PCB
3D PCB render ของ flight controller revision 1
3D PCB Render ของ Revision แรก
Flight controller revision 2 PCB front
Revision 2.0 ด้านหน้า
Flight controller revision 2 PCB back
Revision 2.0 ด้านหลัง
Flight controller revision 2 3D front render
Revision 2.0 3D Render ด้านหน้า
Flight controller revision 2 3D back render
Revision 2.0 3D Render ด้านหลัง
Flight controller revision 2.1 front
Revision 2.1 ด้านหน้า
Flight controller revision 2.1 back
Revision 2.1 ด้านหลัง

Schematic และ RF Layout

Hierarchical schematic ของ flight controller revision 1
Hierarchical Schematic ของ Flight Controller Revision 1

Repository แยก Schematic ออกเป็น MCU, Sensors, Power และ RF ทำให้เห็นการเปลี่ยนแปลงของแต่ละ Revision ได้ชัด

RF Section รอบ nRF24L01 ใช้ Continuous Ground Plane และ Stitching Vias ประมาณ 6 mm ตาม Layout ที่ผู้สร้างอธิบายไว้

MCU schematic revision 1
MCU Section Revision 1
Sensor schematic revision 1
Sensor Section Revision 1
Power schematic revision 1
Power Section Revision 1
RF schematic revision 1
RF Section Revision 1
Hierarchical schematic revision 2
Hierarchical Schematic Revision 2
MCU schematic revision 2
MCU Section Revision 2
Sensor schematic revision 2
Sensor Section Revision 2
Power schematic revision 2
Power Section Revision 2
RF schematic revision 2
RF Section Revision 2
MCU schematic revision 2.1
MCU Section Revision 2.1
Sensor schematic revision 2.1
Sensor Section Revision 2.1
Power schematic revision 2.1
Power Section Revision 2.1
RF schematic revision 2.1
RF Section Revision 2.1

Custom Remote ใช้ STM32L432KC

Custom STM32 remote controller ของ No Fly Zone
Remote Controller ที่ผู้สร้างออกแบบ PCB และ Housing เอง

Remote ใช้:

  • STM32L432KC
  • SSD1306 OLED
  • TMR Joysticks
  • Rotary Encoder
  • nRF24L01
  • 1S LiPo

Firmware README ระบุว่า Remote สื่อสารกับ Quadcopter ที่ 200 Hz และรองรับ ARM/DISARM, Joystick Calibration และ PID Tuning

ภายใน custom remote controller
ภายใน Remote Housing และ PCB
Custom remote PCB render
Remote PCB Render
3D render ของ remote PCB
3D PCB Render ของ Remote
Fusion 360 remote enclosure render
CAD Render ของ Remote Housing

Remote Architecture และ Wireless Link

Software flow diagram ของ custom drone remote
Software Flow ของ Remote Controller

Quadcopter ส่ง ACK Packet กลับมายัง Remote พร้อม State และ Battery Level ที่ผ่าน Running Average

Remote hierarchical schematic
Remote Hierarchical Schematic
Remote STM32L432 MCU schematic
Remote MCU Section
Remote radio OLED joystick encoder schematic
Remote Radio, OLED, Joystick และ Encoder Section

OLED ใช้ดู Battery, Calibration และ PID

OLED หน้า battery monitor ของ drone remote
OLED Page 1 แสดง Battery ของ Remote และ Quadcopter
OLED joystick calibration page
Joystick Calibration Page
OLED PID tuning page
PID Tuning Page

Safety และ Failsafe อยู่ใน Firmware

Repository ระบุ Safety Mechanism หลายส่วน:

  • Software Watchdog
  • Failsafe เมื่อ Sensor Data stale
  • Failsafe เมื่อ Remote Link หาย
  • Low-battery shutdown
  • ARM / DISARM Mode
  • Motors หยุดเมื่อเข้าสู่ Failsafe
Quadcopter ใช้ Brushless Motors, Propellers, 60A ESC และ 4S LiPo ซึ่งมีความเสี่ยงด้าน Mechanical Injury, High Current และ Battery Safety Source ไม่ได้ให้ Complete Bench-safety Procedure ดังนั้นควรอ้างอิงคู่มือของ Hardware แต่ละชิ้น และทดสอบในพื้นที่ควบคุมอย่างเหมาะสม

Hardware หลักของ Quadcopter

รายการ ข้อมูลจาก BOM
Frame FPVDrone 225 mm, 5-inch
Motor FLASH HOBBY Arthur 2207.5 1900KV ×4
ESC AERO SERLFIE 60A 4-in-1 ESC, 2S–6S LiPo
Propeller HQProp Ethix S4 5×3.7×3
Battery OVONIC 4S 1550mAh 14.8V 100C
Remote OLED 0.96-inch SSD1306 OLED
Remote Battery 3.7V 1100mAh LiPo
Main Article และ BOM ไม่ได้ระบุราคา จึงไม่มี Total Build Cost หรือราคาเงินบาทในบทความนี้

Remote Housing มีไฟล์ Fusion 360 ให้ดาวน์โหลด

Repository มีไฟล์ no_fly_zone_remote_v1_0.f3d สำหรับ Remote Housing

CAD มี Cutout สำหรับ Joystick, Encoder, OLED และพื้นที่สำหรับ LiPo กับ PCB

Repository ไม่ได้ให้ STL และ Source ไม่ได้ระบุ Layer Height, Infill, Nozzle, Material, Support หรือ Print Temperature ดังนั้นไม่ควรสร้าง Printing Settings เพิ่มเอง
ดาวน์โหลด Fusion 360 Remote CAD

Source Code เขียนเอง ไม่ใช้ Betaflight

Repository มี Flight Firmware และ Remote Firmware เป็น Source จริง รวมถึง DShot, Madgwick, Joystick, OLED และ RF structures

ผู้สร้างระบุว่า AI ใช้เฉพาะ Python Test Scripts ไม่ได้ใช้สร้าง Flight หรือ Remote Firmware

Quaternion Error → Rate Error excerpt
float w_x_err, w_y_err, w_z_err;
madgwick_curr_to_des(&state, pkt.q_des, k_att,
                     &w_x_err, &w_y_err, &w_z_err);
Failsafe motor stop excerpt
// immediately stop and disable motors
bldc_stop(&bldc);

Firmware, KiCad, Gerber, BOM และ CAD Downloads

ดาวน์โหลด Project ทั้งหมด

Flight Controller Firmware

Remote Firmware

Flight Controller Gerber / Fabrication

Flight Controller KiCad / BOM

Remote PCB / Gerber / BOM

Remote CAD

Repository ไม่มี GitHub Release ดังนั้นไฟล์ด้านบนเป็น Source และ Fabrication Files จาก Main Branch ไม่ใช่ Binary Release Package

มี Video ของ No Fly Zone หรือไม่?

จาก CircuitDigest, GitHub Repository, Original Project references และการค้นชื่อ Project / Maker ยังไม่พบ Dedicated YouTube, MP4, WebM หรือ MOV ที่ยืนยันว่าเป็น No Fly Zone ตัวนี้โดยตรง

Repository เองมี Media 48 ไฟล์ แต่ทั้งหมดเป็น PNG/JPEG และไม่มี Video File

ดังนั้น HTML นี้ไม่ฝัง Video ของ STM32 Drone จากโปรเจกต์อื่นเพื่อป้องกันความเข้าใจผิด

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

No Fly Zone ใช้ Betaflight หรือไม่?

ไม่ Flight และ Remote Firmware ถูกเขียนเอง โดยผู้สร้างระบุเพียงว่าได้รับแรงบันดาลใจบางส่วนจาก PixHawk และ Betaflight

Flight Controller ใช้ MCU อะไร?

STM32F446RCT

Remote ใช้ MCU อะไร?

STM32L432KC

IMU รุ่นอะไร?

LSM6DS3TR

มี Barometer หรือไม่?

มี LPS25HB แต่ Firmware README ระบุว่า ปัจจุบันยังไม่ได้ใช้สำหรับ Altitude Hold

ใช้ Sensor Fusion แบบไหน?

ใช้ Madgwick Filter

STM32 ขับ Motor โดยตรงหรือไม่?

ไม่ STM32 ส่ง DShot Command ไปยัง Commercial 4-in-1 ESC ซึ่งเป็นตัวขับ BLDC Motors

DShot ถูกสร้างอย่างไร?

ผู้สร้างใช้ Timer และ DMA เพื่อสร้าง Digital Bitstream

Remote สื่อสารด้วยอะไร?

ใช้ nRF24L01 ที่ 2.4GHz

Remote Update Rate เท่าไร?

Firmware README ระบุ Wireless Communication ที่ 200 Hz

มี Failsafe หรือไม่?

มีสำหรับ Sensor Data stale, Lost Remote Communication และ Low Battery

มี GPS หรือ Magnetometer หรือไม่?

Revision 1.0 เคยมี แต่ Revision ต่อมาถอดออก

PCB ล่าสุดขนาดเท่าไร?

Revision 2.1 ลดขนาดจาก 50 × 50 mm เป็น 40 × 40 mm

มี Gerber ให้ดาวน์โหลดหรือไม่?

มี Fabrication ZIP สำหรับหลาย Revision รวมถึง Flight Controller Rev 1.0, Rev 2.0, Rev 2.1 และ Remote Revised

มี KiCad Files หรือไม่?

มีทั้ง PCB และ Schematics

มี Firmware Source หรือไม่?

มีทั้ง Flight Controller และ Remote Firmware

มีไฟล์ 3D Printing หรือไม่?

มี Fusion 360 `.f3d` ของ Remote Housing แต่ Source ไม่ให้ STL หรือ Printing Settings

AI เขียน Flight Firmware หรือไม่?

ไม่ ผู้สร้างระบุว่า AI ใช้เฉพาะ Python Test Scripts

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

Source ไม่ได้ระบุ Total Project Cost และ BOM ไม่มีราคา

มี Video หรือไม่?

จาก Sources ที่ตรวจสอบยังไม่พบ Dedicated Video ของ Project นี้โดยตรง

จาก Board ที่มีปัญหา สู่ Flight Controller ที่บินได้จริง

จุดที่น่าสนใจที่สุดของ No Fly Zone ไม่ใช่แค่การเขียน Flight Stack เอง แต่คือการเก็บปัญหาจาก Hardware Revision แรก แล้วปรับทั้ง PCB, RF, Power, Sensor Suite และ Form Factor

Project จึงเป็นตัวอย่างที่ดีของงาน Embedded ที่ Software, PCB Layout, Sensor Fusion, RF และ Mechanical Design ต้องทำงานร่วมกันจริง

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

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

กำลังทำ STM32, Sensor หรือ Wireless Project?

No Fly Zone แสดงให้เห็นว่า Flight Controller หนึ่งตัวไม่ได้มีแค่ MCU แต่ต้องรวม Sensor, RF, Power, Control Algorithm และ PCB Layout เข้าด้วยกัน

หากกำลังพัฒนา STM32, Sensor, Wireless, Embedded System หรือ Development Board สามารถสอบถามทีม Globalbyte เรื่องบอร์ดและอุปกรณ์ที่เหมาะกับ Project ได้

และถ้ามี CAD ของ Enclosure แต่ยังไม่มีเครื่องพิมพ์ สามารถสอบถามทีม Globalbyte เรื่องบริการ 3D Printing ได้เช่นกัน

Disclaimer: บทความนี้เป็นการสรุปและเรียบเรียงจากแหล่งข้อมูลภาษาอังกฤษ อาจมีความคลาดเคลื่อน กรุณาตรวจสอบ Source ต้นฉบับก่อนลงมือทำ Quadcopter Project นี้เกี่ยวข้องกับ Brushless Motors, Propellers, High-current ESC, LiPo Battery และ RF 2.4GHz ซึ่งอาจก่อให้เกิดอันตรายหากใช้งานหรือทดสอบไม่เหมาะสม Source ไม่ได้ให้ Complete Safety Procedure สำหรับการประกอบและทดสอบทั้งหมด จึงควรอ้างอิงคู่มือของ Battery, ESC, Motor และอุปกรณ์แต่ละชิ้นเพิ่มเติม Barometer มีอยู่บน Flight Controller แต่ Firmware Version ที่ Source อธิบาย ยังไม่ได้ใช้สำหรับ Altitude Hold Revision 1 เคยมี GPS และ Magnetometer แต่ถูกนำออกใน Revision ต่อมา Repository มี Fusion 360 CAD ของ Remote Housing แต่ไม่ได้ให้ STL หรือ Printing Settings เช่น Layer Height, Infill, Material, Nozzle, Support หรือ Temperature Main Article และ BOM ไม่ระบุราคา จึงไม่มี Total Project Cost หรือราคาเงินบาทในบทความนี้ Repository ไม่มี Project-level LICENSE ที่ตรวจพบ จึงไม่ควรตีความว่าการเผยแพร่ Source บน GitHub หมายถึงอนุญาตให้ Reuse ทุกไฟล์เชิงพาณิชย์โดยอัตโนมัติ ควรตรวจสิทธิ์กับผู้สร้างก่อนนำ Code, CAD, PCB หรือ Images ไปใช้งานเชิงพาณิชย์

แท็ก


Blog posts