GCS และการสื่อสาร

ตัวอย่างที่ 1 ตรวจไฟล์ .plan ด้วยโปรแกรม

ภารกิจสำรวจน้ำท่วมของ VTOL ที่ความเร็ว 16 m/s (พิกัดสมมติ) โปรแกรมคำนวณระยะแต่ละช่วง เวลาบิน ระยะไกลสุดจากจุดขึ้นบิน และตรวจความสูงเทียบเพดาน 90 m ที่ใช้ในการบินทั่วไปตามกฎ กพท.

import math

plan = {"fileType": "Plan", "version": 1, "groundStation": "QGroundControl",
        "mission": {"version": 2, "cruiseSpeed": 16, "plannedHomePosition": [14.0340, 100.6120, 5.0],
                    "items": [
                        {"type": "SimpleItem", "command": 22, "frame": 3, "params": [0, 0, 0, None, 14.0340, 100.6120, 40]},
                        {"type": "SimpleItem", "command": 16, "frame": 3, "params": [0, 0, 0, None, 14.0450, 100.6200, 90]},
                        {"type": "SimpleItem", "command": 16, "frame": 3, "params": [0, 0, 0, None, 14.0450, 100.6400, 90]},
                        {"type": "SimpleItem", "command": 16, "frame": 3, "params": [0, 0, 0, None, 14.0410, 100.6400, 90]},
                        {"type": "SimpleItem", "command": 16, "frame": 3, "params": [0, 0, 0, None, 14.0410, 100.6200, 120]},
                        {"type": "SimpleItem", "command": 20, "frame": 2, "params": [0, 0, 0, 0, 0, 0, 0]},
                    ]}}
MAX_ALT = 90                                   # m เหนือจุดขึ้นบิน (frame 3)

def haversine(lat1, lon1, lat2, lon2, r=6_371_000):
    p1, p2 = math.radians(lat1), math.radians(lat2)
    dp, dl = p2 - p1, math.radians(lon2 - lon1)
    h = math.sin(dp / 2) ** 2 + math.cos(p1) * math.cos(p2) * math.sin(dl / 2) ** 2
    return 2 * r * math.asin(math.sqrt(h))

m = plan["mission"]
home = m["plannedHomePosition"][:2]
points, problems = [home], []
for i, it in enumerate(m["items"], 1):
    if it["command"] in (16, 22):
        lat, lon, alt = it["params"][4:7]
        points.append([lat, lon])
        if alt > MAX_ALT:
            problems.append(f"item {i}: altitude {alt} m > {MAX_ALT} m")
if m["items"][-1]["command"] != 20:
    problems.append("mission does not end with RETURN_TO_LAUNCH")
points.append(home)
legs = [haversine(*points[k], *points[k + 1]) for k in range(len(points) - 1)]
far = max(haversine(*home, *p) for p in points)
print("legs (m):", [round(x) for x in legs])
print(f"total {sum(legs) / 1000:.2f} km, {sum(legs) / m['cruiseSpeed'] / 60:.1f} min at {m['cruiseSpeed']} m/s, farthest {far / 1000:.2f} km from home")
print("problems:", problems or "none")

legs (m): [0, 1497, 2157, 445, 2157, 1162]
total 7.42 km, 7.7 min at 16 m/s, farthest 3.26 km from home
problems: ['item 5: altitude 120 m > 90 m']

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

ตัวอย่างที่ 2 ขอบฟ้าวิทยุและความสูงขั้นต่ำ

import math

def radio_horizon_km(h1, h2):
    return 4.12 * (math.sqrt(h1) + math.sqrt(h2))

def min_drone_alt(d_km, h_gcs):
    x = d_km / 4.12 - math.sqrt(h_gcs)
    return max(0.0, x) ** 2

print(f"GCS 2 m, drone 90 m: horizon {radio_horizon_km(2, 90):.1f} km")
print(f"GCS 10 m mast, drone 90 m: horizon {radio_horizon_km(10, 90):.1f} km")
for d in (5, 20, 40):
    print(f"to keep radio line of sight at {d:>2} km with a 2 m antenna the drone must be above {min_drone_alt(d, 2):.1f} m")

GCS 2 m, drone 90 m: horizon 44.9 km
GCS 10 m mast, drone 90 m: horizon 52.1 km
to keep radio line of sight at  5 km with a 2 m antenna the drone must be above 0.0 m
to keep radio line of sight at 20 km with a 2 m antenna the drone must be above 11.8 m
to keep radio line of sight at 40 km with a 2 m antenna the drone must be above 68.8 m

พื้นที่ทำแผนที่ของกรณีนี้อยู่ห่างไม่ถึง 4 km ขอบฟ้าวิทยุจึงไม่เป็นข้อจำกัด แต่ถ้าต้องค้นหาผู้ประสบภัยไกล 40 km ต้องบินสูงเกือบ 70 m เพียงเพื่อพ้นความโค้งของโลก ยังไม่นับสิ่งกีดขวาง ซึ่งเป็นการบินนอกระยะสายตาที่ต้องได้รับอนุญาตเฉพาะ