# 精准着陆

PX4 支持多旋翼精准着陆(从 PX4 1.7.4版本),这一功能使用 IR-LOCK 传感器和 IR 信标(如 IR-LOCK MarkOne )以及朝下的距离传感器。 这使飞行器能以约 10 cm 的精度着陆(相比之下,GPS 的精度可能达到几米)。

精准着陆可由切换至 精准着陆 飞行模式或作为 任务 的一部分来启动。

# 设置

# 硬件安装

按照官方指南安装 IR-LOCK 传感器。 确保传感器的 x 轴与飞行器的 y 轴对齐,并且传感器的 y 轴与飞行器的 x 方向对齐(如果摄像头从正面朝下倾斜 90 度,则会出现这种情况)。

安装 范围/距离传感器(已发现 * LidarLite v3 * 效果良好)。

Note许多基于红外线的距离传感器在 IR-LOCK 信标存在的情况下表现不佳。 有关其他兼容传感器,请参阅 IR-LOCK 指南。

# 固件配置

精确着陆需要模块 irlocklanding_target_estimator ,默认情况下不包含在 PX4 固件中。 They can be included by adding (or uncommenting) the following lines in the relevant configuration file for your flight controller (e.g. Firmware/boards/px4/fmu-v5/default.cmake):

drivers/irlock
modules/landing_target_estimator

这两个模块也应该在系统启动时启动。 For instructions see: customizing the system startup.

# 软件配置(参数)

Precision landing is configured with the landing_target_estimator and navigator parameters, which are found in the "Landing target estimator" and "Precision land" groups, respectively. 最重要的参数将在下面讨论。

参数 LTEST_MODE 决定信标是被认为静止的还是移动的。 如果 LTEST_MODE 被设置为移动的(例如,它所安装得多旋翼飞行器将要在运动车辆上着陆),则信标测量仅用于在精准着陆控制器中产生位置设定点。 如果 LTEST_MODE 被设置为静止得,则飞行器位置估计器(EKF2 或 LPE)也使用信标测量结果。

参数 LTEST_SCALE_X LTEST_SCALE_Y 可用于在估计信标相对于飞行器的位置和速度之前对信标测量结果进行缩放。 由于 IR-LOCK 传感器的镜头失真,可能需要进行测量缩放。 注意,在传感器坐标系中考虑LTEST_SCALE_XLTEST_SCALE_Y,而不是飞行器坐标系。

To calibrate these scale parameters, set LTEST_MODE to moving, fly your multicopter above the beacon and perform forward-backward and left-right motions with the vehicle, while logging landing_target_pose and vehicle_local_position. 然后,将 landing_target_pose.vx_rellanding_target_pose.vy_rel 分别与vehicle_local_position.vxvehicle_local_position.vy 进行比较(均在NED坐标系中测量)。 如果估计的信标速度始终小于或大于飞行器速度,则调整缩放参数以进行补偿。

如果在 LTEST_MODE 设置为静止的情况下进行精准着陆时观察到飞行器缓慢侧向振荡,则信标测量可能会缩放得太高,您应该减小相关方向上的缩放参数。

# 精准降落模式

精确着陆可以配置为“必需的”或“随机的”。 模式的选择会影响精准着陆的执行方式。

# 必须的模式

必须的模式 中,如果在启动着陆时信标不可见,则飞行器将搜索信标。 如果找到信标,飞行器将执行精准着陆。

搜索过程包括爬到搜索高度( PLD_SRCH_ALT )。 如果信标在搜索高度仍然不可见并且在搜索超时( PLD_SRCH_TOUT )之后,则在当前位置启动正常着陆。

# 随机的模式

随机的模式 中,如果(并且仅当)在启动着陆时信标可见,则飞行器将使用精准着陆<0>。 如果此时不可见,则飞行器立即在当前位置执行正常着陆。

# 执行精准着陆

Note由于位置控制器的当前实施方式的限制,只有具有有效的全局位置时才能实现精准着陆。

# 通过命令

精准着陆可以通过命令行接口启动:

commander mode auto:precland

在这种情况下,精准着陆始终被视为“必需的”。

# 在任务中 {#mission}

精准着陆可以作为 任务 的一部分启动,使用 MAV_CMD_NAV_LAND 并适当设置 param2

  • param2 = 0: 正常着陆而不使用信标。
  • param2 = 1:随机的 精准着陆。
  • param2 = 2:必需的 精准着陆。

# 仿真

Precision landing with the IR-LOCK sensor and beacon can be simulated in SITL Gazebo.

可以运行下列命令来开启拥有 IR-LOCK 信标,带测距传感器的飞行器,IR-LOCK 摄像头的仿真世界:

make px4_sitl gazebo_iris_irlock

你可以通过在 Gazebo GUI 中移动信标或通过改变在 Gazebo world 中的位置来改变信标的位置。

# 工作原理

# 着陆目标估计器

landing_target_estimatorirlock 驱动中获取测量结果以及估计的地形高度,来估计信标相对于飞行器的位置。

irlock_report 中的测量值包含从图像中心到信标的角度的正切值。 换句话说,测量值是指向信标的矢量的 x 和 y 分量,其中 z 分量具有长度“1”。 这意味着将测量结果缩放从摄像头到信标的距离这么多倍,将得到从摄像头到信标的(方向)矢量。 然后根据飞机的姿态估计将相对位置旋转到北对齐,机身水平的坐标系中。 相对位置测量的 x 和 y 分量都在单独的卡尔曼滤波器中滤波,卡尔曼滤波器用作简单的低通滤波器,其也产生速度估计并允许异常值剔除。

每当新的irlock_report融合到估计中时,landing_target_estimator就发布估计的相对位置和速度。 如果未看到信标或信标测量结果被拒绝,则不会发布任何内容。 着陆目标估计发布在landing_target_pose uORB 消息中。

# 改进的飞行器位置估计

如果使用参数LTEST_MODE将信标指定为静止,则可以借助信标测量来改善飞行器的位置/速度估计。 这是通过融合信标的速度为飞行器负速度的测量来完成的。

# 精准着陆过程

精准着陆由三个阶段组成:

  1. **水平接近:**飞行器在保持其当前高度的同时水平接近信标。 一旦信标相对于车辆的位置差异低于阈值( PLD_HACC_RAD ),就进入下一阶段。 如果信标在此阶段丢失(不可见超过时长 PLD_BTOUT ),则启动搜索程序(在必须的精准降落模式)或飞行器正常着陆(在随机的精准降落模式)。

  2. **信标上方降落:**飞行器下降,同时保持在信标中心上方。 如果信标在此阶段丢失(不可见超过时长PLD_BTOUT),则启动搜索程序(在必须的精准降落模式)或飞行器正常着陆(在随机的精准降落模式)。

  3. **最终接近:**当飞行器接近地面(高度小于 PLD_FAPPR_ALT )时,飞行器会下降,同时保持在信标中心上方。 如果信标在此阶段丢失,则会继续下降,与精准着陆的类型无关。

在步骤 1. 和步骤 2.中 搜索次数最多达 PLD_MAX_SRCH 次。

精准着陆流程图