EKF3 水平位置源换成 VIO:室内无 GPS 的配置清单与四条验收判据
室内飞行的第一个硬约束不是控制,是定位。没有 GPS,ArduCopter 的 EKF3 必须从一个外部源拿水平位置和速度,否则连 GUIDED 里的位置通道都用不了 —— 而我这套任务层恰恰只发位置指令。 这篇是”把光流换成 MICO VIO”这件事的完整记录:配置怎么做、怎么验、以及我在这上面错的四次。 一、先明确要接什么 量 从哪来 参数 水平位置 XY VIO(MAVLink VISION_POSITION_ESTIMATE) EK3_SRC1_POSXY = 6 水平速度 XY 同上 EK3_SRC1_VELXY = 6 垂直速度 同上 EK3_SRC1_VELZ = 6 高度 测距仪(ToF) EK3_SRC1_POSZ = 2 航向 VIO 的 yaw EK3_SRC1_YAW = 6 VIO 输入 MAVLink,串口 4 SERIAL4_PROTOCOL = 2、SERIAL4_BAUD = 921 测距仪 型号 10、朝向 25 RNGFND1_TYPE = 10、RNGFND1_ORIENT = 25、MIN = 0.01、...
uast-lite 项目进度:真机自主飞行已跑通
这篇是给自己留的“进门先看这里”。每次有大进展就更新一次。 现在能做什么比赛要的动作已经能一次做完:起飞到 1.29 m,朝北飞 4.62 m 越过判定线,再飞回来降落上锁。任务层报的是正常结束(MS DONE rt=4 rs=NONE),不是中止。 三个踩过的坑起飞推不起来,不是任务层的问题。 悬停油门 MOT_THST_HOVER 被飞控的自学功能拖低,起飞推力不够,飞机离不了地;而 ArduPilot 在地面状态下会忽略位置目标的 z,所以任务发了也没反应。 判断飞机往哪飞,只能看飞控日志。 调试口的 SELF 是位置回显,任务结束以后 VIO 还会漂。 参数是会变的。 MOT_THST_HOVER 有自学开关,查“起不来”要先翻日志里的参数快照。 固件里现在是什么值 项 值 DRONE_MISSION_STAGE 0(完整任务) DRONE_MISSION_START_SW_AUTO_RESET 0(实飞必须 0) 起飞 / 巡航高度 1.2 m / 1.2 m 判定线(北向目标) 4.5 m 到位容差 0.3 m 安全圈...
MOT_THST_HOVER 自学导致起飞失败:一次飞控参数排故实录
飞控日志 250.BIN,问题清单里对应 #233 / #234。 结果123456起飞 1.29 m → 向北 4.62 m(目标 4.5)→ 返航 → 降落MS DONE rt=4 rs=NONE 任务层正常结束,不是中止PN -0.06 .. 4.62 北向到位PE 0.03 .. 0.27 东向只偏 27 cm(容差 30 cm)PD -1.29 .. 0.56 高度 1.29 m(目标 1.2)偏航差 7°,平移时前倾 21°,总共飞了 13.9 秒 250 这次成功起飞的真实录像(13 秒):从地面推到悬停、越线、返航降落。 从飞控日志 250.BIN 的 XKF1 画出的水平轨迹。颜色是时间先后(深紫最早、黄绿最晚),橙色虚线是 4.0 m 判定线,灰点是 4.5 m 目标。飞机从原点起飞、向北越过判定线、再回到原点降落。 之前一直飞不起来的真正原因我一直以为是任务层发错了,或者飞控没收到指令。其实是飞控压在地面上,不认位置目标的高度: 123456MO...