Python无人机程序错误捕获与故障安全机制实现咨询

阿华AIGC实验室

2026-5-20

给你的Python无人机代码加上可靠的故障安全机制

嘿，作为刚入门Python无人机编程的新手，碰到程序崩溃但无人机还继续乱飞的情况真的挺闹心——毕竟失控的无人机不仅可能损坏设备，还存在不小的安全隐患。别慌，咱们一步步来给你的代码补上靠谱的安全兜底逻辑，确保任何出错场景下都能让无人机安全落地或者返航。

核心：用异常处理（try-except-finally）覆盖所有代码路径

这是最基础也最关键的一步，把所有可能抛出异常的飞行控制代码都包裹在try块里，然后在except块里触发紧急安全操作，最后用finally做必要的资源清理。

举个实际的代码例子（以DroneKit为例，你可以适配自己用的无人机SDK）：

import time
from dronekit import connect, VehicleMode

def emergency_land(vehicle):
    """紧急降落函数：尽量简化逻辑，避免嵌套异常"""
    print("⚠️ 触发紧急降落！")
    # 切换到降落模式
    vehicle.mode = VehicleMode("LAND")
    # 等待降落完成（可加超时判断防止无限等待）
    while vehicle.location.global_relative_frame.alt > 0.1:
        print(f"当前高度: {round(vehicle.location.global_relative_frame.alt, 1)}m，正在降落...")
        time.sleep(1)
    # 关闭动力并断开连接
    vehicle.armed = False
    vehicle.close()

def main():
    vehicle = None
    try:
        # 连接无人机
        vehicle = connect('/dev/ttyUSB0', baud=57600, wait_ready=True)
        # 你的飞行逻辑：起飞、航线飞行等
        vehicle.mode = VehicleMode("GUIDED")
        vehicle.armed = True
        vehicle.simple_takeoff(10)
        # ... 其他飞行任务代码 ...
        
    except KeyboardInterrupt:
        print("\n用户中断程序，执行紧急降落")
        if vehicle:
            emergency_land(vehicle)
    except Exception as e:
        print(f"❌ 程序发生未知错误: {str(e)}，执行紧急降落")
        if vehicle:
            emergency_land(vehicle)
    finally:
        # 无论是否异常，确保关闭无人机连接
        if vehicle and vehicle.is_connected:
            print("🔌 关闭无人机连接")
            vehicle.close()

if __name__ == "__main__":
    main()

注意：emergency_land函数要尽量简洁，别在里面写复杂逻辑，避免又抛出新的异常导致安全操作失效。

进阶：添加看门狗（Watchdog）机制

有时候程序可能不是抛出异常，而是进入死循环或者卡死状态（比如传感器数据阻塞），这时候异常处理就没用了。看门狗能定期检查主程序的心跳，如果超过时间没收到心跳，就强制触发紧急操作。

你可以用Python的threading模块实现简单的看门狗：

import threading
import time

class Watchdog:
    def __init__(self, timeout, callback):
        self.timeout = timeout
        self.callback = callback
        self.timer = threading.Timer(self.timeout, self.trigger)
        self.is_alive = True

    def start(self):
        self.timer.start()

    def reset(self):
        """重置看门狗，表示程序正常运行"""
        if self.is_alive:
            self.timer.cancel()
            self.timer = threading.Timer(self.timeout, self.trigger)
            self.timer.start()

    def trigger(self):
        """超时未重置，触发紧急回调"""
        self.is_alive = False
        self.callback()

# 在主函数里使用看门狗
def main():
    vehicle = None
    def watchdog_callback():
        print("🐶 看门狗触发！程序无响应，执行紧急降落")
        if vehicle:
            emergency_land(vehicle)
    
    # 设置5秒超时：如果5秒内没重置看门狗，就触发紧急操作
    watchdog = Watchdog(timeout=5, callback=watchdog_callback)
    watchdog.start()

    try:
        vehicle = connect('/dev/ttyUSB0', baud=57600, wait_ready=True)
        while True:
            # 你的飞行逻辑循环
            print("执行飞行任务...")
            # 每次循环重置看门狗，告诉它"我还活着"
            watchdog.reset()
            time.sleep(1)
            # ... 其他飞行操作 ...
    except Exception as e:
        print(f"❌ 程序出错: {str(e)}")
        if vehicle:
            emergency_land(vehicle)
    finally:
        # 关闭看门狗
        watchdog.is_alive = False
        watchdog.timer.cancel()
        if vehicle:
            vehicle.close()

看门狗的超时时间要根据你的飞行逻辑调整——如果单次任务执行时间长，就把超时设大一点，避免误触发。

额外：实时监控无人机硬件状态

除了程序本身的异常，还要监控无人机的硬件状态（比如电池电量过低、信号丢失、姿态异常），一旦出现这些情况，主动触发安全操作。

比如在飞行循环里加入状态检查：

def check_vehicle_status(vehicle):
    """检查无人机状态，异常返回True"""
    # 检查电池电量（低于20%触发返航）
    if vehicle.battery.level < 20:
        print("🔋 电池电量过低，触发返航")
        return True
    # 检查信号强度（如果是数传连接）
    if getattr(vehicle, 'rssi', 0) < 20:
        print("📶 信号强度过低，触发紧急降落")
        return True
    # 检查飞行模式是否正常
    if vehicle.mode.name not in ["GUIDED", "AUTO"]:
        print("🔧 飞行模式异常，触发紧急降落")
        return True
    return False

# 在飞行循环里调用状态检查
while True:
    if check_vehicle_status(vehicle):
        emergency_land(vehicle)
        break
    # 执行飞行任务
    ...