设置失控行为

MAV_CMD_NAV_GUIDED_ENABLE 92

返回command = MAV_CMD_REQUEST_MESSAGE
返回值 param1 92 执行命令id
返回值 param2 0或1 是否执行成功
返回值 param3 失败代码(0无异常 1无法获取无人机信息 2无法设置失控行为)

python测试脚本

import time
from pymavlink import mavutil

timestamp = int(time.time() * 1000)
millis = int(time.time() * 1000)

master = mavutil.mavlink_connection('udpin:0.0.0.0:14550')
master.wait_heartbeat()
boot_time = time.time()

def set_rc_lost(status):
    master.mav.command_long_send(
        master.target_system,
        master.target_component,
        mavutil.mavlink.MAV_CMD_NAV_GUIDED_ENABLE,
        0,
        0, status, 0, 0, 0, 0, 0
    )
#0 hover 1 land 2 go home
set_rc_lost(0)

while True:
    msg = master.recv_match()
    if not msg:
        continue
    if msg.get_type() == 'COMMAND_LONG':
        print("\n\n*****Got message: %s*****" % msg.get_type())
        print("Message: %s" % msg)
        print("\nAs dictionary: %s" % msg.to_dict())