设置相机焦点

MAV_CMD_SET_CAMERA_FOCUS 532

设置镜头对焦目标点。

返回值 param1 532 执行命令id
返回值 param2 0或1 是否执行成功
返回值 param3 失败代码
0 无异常
1 无法初始化镜头控制
2 无法设置相机模式
3 无法设置焦点

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 focus():
    master.mav.command_long_send(
        master.target_system,
        master.target_component,
        mavutil.mavlink.MAV_CMD_SET_CAMERA_FOCUS,
        0,
        3,
        4, 
        0, 0, 0, 0, 0
    )

focus()

调用脚本

执行结果