ขับเคลื่อน ควบคุม และนำทาง
UAT 301 เทคโนโลยีระบบอากาศยานไร้คนขับ
บทเรียน
เมื่อเรียนจบโมดูลนี้ ผู้เรียนจะสามารถ
- ประมาณกำลังที่ใช้บินของโดรนหลายใบพัด ปีกตรึง และ VTOL จากหลักฟิสิกส์
- เปรียบเทียบเวลาบินและพื้นที่ทำแผนที่ต่อเที่ยวของสามสถาปัตยกรรม
- อธิบายชั้นของระบบควบคุมการบินและโหมดการบิน
- คำนวณ DOP จากตำแหน่งดาวเทียม และประมาณความคลาดเคลื่อนตำแหน่ง GNSS
ทำไมต้องรู้
เวลาบินและความแม่นของตำแหน่งเป็นสองตัวเลขที่ตัดสินว่าโดรนทำภารกิจได้หรือไม่ ผู้ขายมักให้ค่าเวลาบินสูงสุดที่วัดในสภาพดีที่สุด วิศวกรต้องประมาณเองได้จากหลักฟิสิกส์ เพื่อเทียบสถาปัตยกรรมอย่างเป็นธรรม โมดูลนี้ใช้กรณีเดิม: ศูนย์ป้องกันภัยจังหวัดต้องทำแผนที่น้ำท่วม 4 km² หน่วยความรู้เรื่องออกแบบและประกอบรวมระบบของคลังความรู้โดรนแนะนำให้แปลงภารกิจเป็นงบน้ำหนักและกำลังไฟก่อนเลือกชุดขับเคลื่อน
กำลังที่ใช้บินของสามสถาปัตยกรรม
โดรนหลายใบพัด ต้องสร้างแรงยกเท่าน้ำหนักด้วยใบพัดตลอดเวลา ทฤษฎีโมเมนตัมของ Leishman ให้กำลังลอยตัวในอุดมคติ เมื่อ คือพื้นที่จานใบพัดรวม ใบพัดจริงสูญเสียมากกว่านี้ จึงหารด้วย figure of merit (FM) ซึ่งสำหรับใบพัดเล็กอยู่ราว 0.5–0.7 (Bauersfeld และ Scaramuzza, 2022) และหารด้วยประสิทธิภาพมอเตอร์กับ ESC
โดรนปีกตรึง ใช้ปีกสร้างแรงยก ใบพัดเพียงเอาชนะแรงต้าน ซึ่งเท่ากับน้ำหนักหารด้วยอัตราส่วนแรงยกต่อแรงต้าน กำลังจึงเท่ากับ หารด้วยประสิทธิภาพของใบพัดและระบบไฟฟ้า (Fahlstrom และคณะ)
VTOL ขึ้นลงแนวดิ่งด้วยใบพัดยก แล้วบินเดินทางด้วยปีก จึงแบกมอเตอร์ชุดยกที่ไม่ได้ใช้ระหว่างบินเดินทาง มวลมากขึ้นและ ต่ำลง
ตัวอย่างที่ 1 เวลาบินและพื้นที่ต่อเที่ยวด้วยแบตเตอรี่เท่ากัน
แบตเตอรี่ 6S 10 Ah (22.2 V) ใช้ได้ 80% ของพลังงาน หลายใบพัดหนัก 3.0 kg ใบพัด 15 นิ้ว ปีกตรึงหนัก 3.0 kg 10 VTOL หนัก 3.6 kg 8 ใบพัดยก 13 นิ้ว ลอยตัวรวม 2 นาที ทำแผนที่ด้วยแนวภาพกว้าง 150 m ซ้อนด้านข้าง 70% เผื่อพลังงานสำรอง 20% (ค่าสมมติ)
import math
G, RHO = 9.81, 1.225
E_USABLE = 22.2 * 10 * 0.8 # Wh
RESERVE, SWATH, SIDELAP = 0.20, 150, 0.70
def hover_power(m, d_prop, n=4, fm=0.6, eta=0.8):
thrust = m * G
area = n * math.pi * (d_prop / 2) ** 2
return thrust ** 1.5 / math.sqrt(2 * RHO * area) / fm / eta
def cruise_power(m, v, ld, eta=0.6 * 0.85): # ประสิทธิภาพใบพัด × ระบบไฟฟ้า
return m * G * v / ld / eta
def area_km2(cruise_min, v):
return cruise_min * (1 - RESERVE) * 60 * v * SWATH * (1 - SIDELAP) / 1e6
p_mr = hover_power(3.0, 0.381)
p_fw = cruise_power(3.0, 16, 10)
p_hv, p_cr = hover_power(3.6, 0.33), cruise_power(3.6, 16, 8)
t_mr, t_fw = E_USABLE / p_mr * 60, E_USABLE / p_fw * 60
t_vcruise = (E_USABLE - p_hv * 2 / 60) / p_cr * 60
print(f"multirotor {p_mr:5.1f} W {t_mr:5.1f} min {area_km2(t_mr, 10):.2f} km2 per flight")
print(f"fixed-wing {p_fw:5.1f} W {t_fw:5.1f} min {area_km2(t_fw, 16):.2f} km2 per flight")
print(f"VTOL hover {p_hv:.0f} W, cruise {p_cr:.1f} W {t_vcruise + 2:5.1f} min {area_km2(t_vcruise, 16):.2f} km2 per flight")
multirotor 314.7 W 33.9 min 0.73 km2 per flight
fixed-wing 92.3 W 115.4 min 3.99 km2 per flight
VTOL hover 478 W, cruise 138.5 W 72.0 min 2.42 km2 per flight
ปีกตรึงบินได้นานกว่าหลายใบพัดมากกว่าสามเท่า เพราะใช้กำลังน้อยกว่ามาก ส่วน VTOL ใช้กำลังสูงมากขณะลอยตัว แต่ช่วงสั้น จึงได้เวลาบินอยู่กลางระหว่างสองแบบ ตัวเลขนี้เป็นการประมาณเบื้องต้น การบินไปข้างหน้าของหลายใบพัดจริงใช้กำลังต่างจากการลอยตัว และลมแรงลดเวลาบินของทุกแบบ
ระบบควบคุมการบิน
ออโตไพลอตอย่าง PX4 และ ArduPilot แบ่งการควบคุมเป็นชั้น (เรียนละเอียดใน UAT 206): ชั้นในสุดคุมอัตราการหมุน ถัดมาคุมท่าทาง ถัดมาคุมความเร็วและตำแหน่ง และชั้นนอกสุดคือการนำทางตามภารกิจ โหมดการบิน กำหนดว่าชั้นใดรับคำสั่งจากนักบิน เช่น โหมดคุมท่าทางให้นักบินสั่งมุมเอียงเอง โหมดคงตำแหน่งให้ระบบรักษาตำแหน่งด้วย GNSS และโหมดภารกิจให้ระบบบินตามจุดเส้นทาง เมื่อ GNSS เสื่อม ระบบที่ดีต้องลดระดับไปใช้โหมดที่ไม่พึ่งตำแหน่ง และนักบินต้องฝึกบินในโหมดนั้นให้คล่อง
นำทางด้วย GNSS
หน่วยความรู้เรื่อง GNSS ของคลังความรู้โดรนย้ำให้แยกข้อมูลตำแหน่งออกจากระบบควบคุม เพื่ออ่านสถานะอากาศยานอย่างมีบริบท ความคลาดเคลื่อนของตำแหน่งมาจากสองส่วน คือ ความคลาดเคลื่อนของระยะถึงดาวเทียมแต่ละดวง (user equivalent range error, UERE) และ รูปทรงของดาวเทียม ที่วัดด้วย DOP (dilution of precision) ตามตำรา Groves ความคลาดเคลื่อนแนวราบประมาณ มาตรฐานสมรรถนะของ GPS (SPS Performance Standard ฉบับที่ 5, 2020) กำหนดความแม่นของสัญญาณจากอวกาศ (SIS URE) ไว้ไม่เกิน 7.0 m (95%) สำหรับดาวเทียมแต่ละดวง และไม่เกิน 2.0 m (95%) เมื่อเฉลี่ยทั้งกลุ่มดาวเทียม และกำหนดความแม่นตำแหน่งเฉลี่ยทั่วโลกไม่เกิน 8 m แนวราบ (95%) ความคลาดเคลื่อนรวมที่ผู้ใช้เห็นยังมีผลของบรรยากาศ สัญญาณสะท้อน และเครื่องรับเพิ่มเติม
ตัวอย่างที่ 2 DOP ในที่โล่งและระหว่างอาคาร
DOP คำนวณจากเมทริกซ์ทิศทาง ของดาวเทียม แต่ละแถวคือเวกเตอร์หนึ่งหน่วยจากผู้ใช้ไปดาวเทียม (ตะวันออก เหนือ ขึ้น) ต่อท้ายด้วย 1 สำหรับนาฬิกาเครื่องรับ แล้ว
import math
import numpy as np
def dop(sats): # (มุมทิศ, มุมเงย) องศา
rows = []
for az, el in sats:
a, e = math.radians(az), math.radians(el)
rows.append([math.cos(e) * math.sin(a), math.cos(e) * math.cos(a), math.sin(e), 1.0])
g = np.array(rows)
q = np.linalg.inv(g.T @ g)
return math.sqrt(q[0, 0] + q[1, 1]), math.sqrt(q[2, 2])
open_sky = [(0, 60), (70, 35), (140, 25), (200, 50), (260, 30), (320, 20), (100, 75), (230, 15)]
urban = [(40, 70), (100, 55), (160, 60), (210, 65), (80, 80)]
UERE = 3.0 # m (1 sigma) ค่าสมมติสำหรับเครื่องรับทั่วไป
for name, sats in (("open sky", open_sky), ("urban canyon", urban)):
h, v = dop(sats)
print(f"{name:<12} {len(sats)} sats HDOP {h:.2f} VDOP {v:.2f} horizontal ~ {h * UERE:.1f} m (1 sigma)")
open sky 8 sats HDOP 0.98 VDOP 1.63 horizontal ~ 2.9 m (1 sigma)
urban canyon 5 sats HDOP 4.36 VDOP 14.44 horizontal ~ 13.1 m (1 sigma)
ระหว่างอาคารสูง ดาวเทียมที่เห็นมีแต่มุมเงยสูงและอยู่ด้านเดียว ความคลาดเคลื่อนแนวราบจึงโตขึ้นหลายเท่า และแนวดิ่งแย่ยิ่งกว่า ถ้างานต้องการความแม่นระดับเซนติเมตร เช่น ทำแผนที่โดยไม่ใช้จุดควบคุมภาคพื้น ต้องใช้ RTK หรือ PPK ซึ่งใช้สถานีฐานแก้ความคลาดเคลื่อนร่วม
ปฏิบัติการประจำโมดูล
ปฏิบัติการ: ตรวจเวลาบินและคุณภาพตำแหน่ง
- ชั่งโดรนฝึกของสาขาพร้อมแบตเตอรี่ วัดขนาดใบพัด แล้วประมาณกำลังลอยตัวด้วยตัวอย่างที่ 1
- ลอยตัวในที่โล่งไร้ลม 3 นาที อ่านกำลังไฟฟ้าจาก log เทียบกับค่าประมาณ แล้วคำนวณ FM ที่สอดคล้อง
- เปิด QGroundControl ดูจำนวนดาวเทียมและ HDOP ในลานโล่งเทียบกับข้างอาคารสูง
- บันทึกตำแหน่งขณะวางโดรนนิ่ง 5 นาทีทั้งสองที่ แล้วคำนวณการกระจายของตำแหน่ง
- เปลี่ยนโหมดจากคงตำแหน่งเป็นคุมท่าทางในสภาพปลอดภัยภายใต้การกำกับของอาจารย์
ข้อผิดพลาดที่พบบ่อย
ระวัง
- เชื่อเวลาบินจากโบรชัวร์ โดยไม่ประมาณเอง
- ลืมพลังงานสำรอง เมื่อคำนวณพื้นที่ต่อเที่ยว
- คิดว่า VTOL ได้ข้อดีของทั้งสองแบบโดยไม่เสียอะไร
- ดูแค่จำนวนดาวเทียม ไม่ดูรูปทรงและ DOP
- ไม่ฝึกบินในโหมดที่ไม่ใช้ GNSS
สรุป
- หลายใบพัดใช้กำลังตามทฤษฎีโมเมนตัม ปีกตรึงใช้กำลังตาม จึงบินได้นานกว่ามาก
- VTOL แลกความสามารถขึ้นลงแนวดิ่งกับมวลและแรงต้านที่เพิ่ม
- ออโตไพลอตควบคุมเป็นชั้น และโหมดการบินกำหนดว่าระบบช่วยนักบินชั้นใด
- ความคลาดเคลื่อน GNSS ประมาณ HDOP × UERE รูปทรงดาวเทียมสำคัญพอ ๆ กับจำนวนดวง
แบบฝึกตรวจความเข้าใจ
- ถ้ามวลโดรนหลายใบพัดเพิ่มเป็นสองเท่า กำลังลอยตัวในอุดมคติเพิ่มกี่เท่า
- ปีกตรึงหนัก 2 kg ความเร็ว 15 m/s 12 ประสิทธิภาพรวม 0.5 ใช้กำลังเท่าใด
- ทำไม VTOL บินได้น้อยกว่าปีกตรึงที่ใช้แบตเตอรี่เท่ากัน
- HDOP 1.5 และ UERE 3 m ความคลาดเคลื่อนแนวราบประมาณเท่าใด
- ทำไมระหว่างอาคารสูง DOP จึงแย่ลง
เฉลย
- เท่า
- W
- แบกมอเตอร์ชุดยกและใช้กำลังสูงขณะลอยตัว มวลมากขึ้นและ ต่ำลง
- m (1σ)
- เห็นดาวเทียมน้อยและอยู่ในทิศแคบ รูปทรงไม่กระจาย
สรุปสูตรสำคัญ
| กำลังลอยตัวตามทฤษฎีโมเมนตัม | |
| กำลังบินเดินทางของปีกตรึง | |
| ความคลาดเคลื่อนตำแหน่ง GNSS |
แหล่งอ้างอิงหลัก
- Leishman, J. G. (2006). Principles of helicopter aerodynamics (2nd ed.). Cambridge University Press.
- Bauersfeld, L., & Scaramuzza, D. (2022). Range, endurance, and optimal speed estimates for multicopters. IEEE Robotics and Automation Letters (arXiv:2109.04741). link
- Fahlstrom, P. G., Gleason, T. J., & Sadraey, M. H. (2022). Introduction to UAV systems (5th ed.). Wiley. link
- Quan, Q. (2017). Introduction to multicopter design and control. Springer Singapore. link
- Groves, P. D. (2013). Principles of GNSS, inertial, and multisensor integrated navigation systems (2nd ed.). Artech House. link
- U.S. Department of Defense. (2020). Global Positioning System standard positioning service performance standard (5th ed.). link
- PX4 Autopilot. PX4 user and developer guide. link
- ArduPilot Dev Team. ArduPilot documentation. link
อ่านเพิ่มเติม
ศึกษาหน่วยความรู้ที่กำหนดล่วงหน้า ดูสื่อประกอบ และทำ quiz ประจำโมดูล
ในชั้นเรียน / ภาคสนาม
ปฏิบัติการในห้องแล็บหรือภาคสนามตามใบงาน พร้อม checklist ความปลอดภัย
หลักฐานการเรียนรู้: ใบงานที่ผ่านการตรวจและผล quiz