Skip to content

Latest commit

 

History

History
163 lines (114 loc) · 11.5 KB

path_planning_interface.md

File metadata and controls

163 lines (114 loc) · 11.5 KB
Raw

路径规划接口

PX4 使用数个 MAVLink 接口来整合机载计算机的路径规划服务（包括在执行航线任务时避障，安全着陆和未来的一些服务）：

如果 COM_OBS_AVOID=1，那么 PX4 的路径规划功能会在自动化模式 （着陆Landing、起飞Takeoff、保持Hold、任务Mission、返回Return）下启用 。 在这些模式中，路径规划软件将为 PX4 提供预设航点；如果软件无法支持特定的飞行模式，则必须将设定值从机体上向下一个位置镜像。

:::tip 这些消息流来自 PX4 的 UORB 主题， 通过 MAVLink 到 ROS，再回传，都在记录在下列文档中：PX4/avoidance > Message Flows。 因此，开发者可以使用这个接口来创建自己新的机载计算机端路径规划服务，或调整现有的规划者软件。

所有使用此接口的服务均发送并且接收相同类型/格式的消息。 因此，开发者可以使用这个接口来创建自己新的机载计算机侧的路径规划服务，或调整现有的规划者软件。

:::note 推荐使用 PX4 Vision Autonomy Development Kit 来开发路径规划软件。 它预安装了 PX4 避障 软件，可以用作您自己算法的基础。 :::

PX4 配置

实际需要的设置/配置取决于所用的规划器。

机载计算机设置

机载计算机侧的硬件设置和硬件/软件配置在 Github 仓库 PX4/avoidance 中已经提供。

实际需要的设置/配置取决于所用的规划器。

:::warning 一次只能有一个规划期在机载计算机上运行（在写入时）。 这意味着不能在同一个无人机上同时启用不同规划器的 offboard 功能。 同时使用无人机（例如，无人机可以支持避障和防撞功能，但不支持安全着陆 - 反之亦然）。 :::

轨迹接口

PX4 将 期望路径 的相关信息发送给机载计算机（当在 自动 模式下，COM_OBS_AVOID=1 时）， 并从路径规划软件接收 已规划路径 的设定点数据流。

期望路径信息由 PX4 通过使用 TRAJECTORY_REPRESTATION_WAYPOINTS 消息来发送，如下文 PX4 航点接口 所述。

路径规划器软件通过 TRAJECTORY_REPRESTATION_WAYPOINTS （参见 Companion Waypoint Interface ）或 TRAJECTORY_REPRESTATION_BEZIER （参见 Companion Bezier Tracjectory Interface ）返回 所规划路径 的设置点。 不同之处在于，前者航点参数只是指定下一个设定的目标航点，而贝塞尔轨迹则描述精确的车辆运动（即随时间变化的设定点）。

:::warning 路由规划软件在执行任务时不应混用这些接口（PX4 将使用最近收到的任意类型的消息）。 :::

PX4 航点接口

PX4 将期望路径封装在 TRAJECTORY_REPRESENTATION_WAYPOINTS 消息中，以 5Hz 的频率发送。

PX4 中各字段定义如下：

  • time_usec: UNIX 纪元时间戳
  • valid_points: 3
  • Point 0 - FlightTaskAutoMapper修改当前航点 适配类型 （参见 以下注释）：
    • pos_x[0], pos_y[0], pos_z[0]: x-y-z NED 坐标系下适应格式的 当前 任务航点位置坐标
    • vel_x[0], vel_y[0], vel_z[0]: x-y-z NED 坐标系下适应格式的 当前 任务航点速度坐标
    • acc_x[0], acc_y[0], acc_z[0]: NaN
    • pos_yaw[0]: 当前航向角
    • vel_yaw[0]: NaN
    • command[0]: 当前航点的 MAVLink 命令
  • Point 1 - 当前航点（未修改/未调整类型）：
    • pos_x[1], pos_y[1], pos_z[1]: x-y-z NED 坐标系下的 当前 任务航点位置坐标
    • vel_x[1], vel_y[1], vel_z[1]: NaN
    • acc_x[1], acc_y[1], acc_z[1]: NaN
    • pos_yaw[1]: 航向设定值
    • vel_yaw[1]: 偏航速率设定值
    • command[1]: 当前航点的 MAVLink 命令
  • Point 2 - 局部坐标系中的下一个航点 (未修改/未调整类型)：
    • pos_x[2], pos_y[2], pos_z[2]: x-y-z NED 坐标系 下一个 任务航点位置坐标
    • vel_x[2], vel_y[2], vel_z[2]: NaN
    • acc_x[2], acc_y[2], acc_z[2]: NaN
    • pos_yaw[2]: 航向设定值
    • vel_yaw[2]: 偏航速率设定值
    • command[2]: 当前航点的 MAVLink 命令
  • 所有其它字段都是NaN(未定义)。

路径规划软件（在机载计算机上运行）可以 以TRAJECTORY_REPRESENTATION_WAYPOINTS 消息流的形式发送所规划路径给 PX4，消息流中包含 Point 0 设定航点。

  • Point 0 是当前根据目标类型所修改的目标航点/目标。 例如，在着陆时指定目标的 x、y 坐标和降落速度是合理的。 为了实现这一点，FlightTaskAutoMapper 修改 Point 0 中的着陆点，将 z 轴位置的分量设置为 NAN，将 z 轴速度设置为期望值。
  • 安全着陆规划器中没有用到 Point 1 和 2。
  • 局部和全局规划器中用到了 Point 1。

机载计算机的失效处理

实现此接口的规划器必须：

  • 如果规划器均未运行并且 COM_OBS_AVOID 在/从启动时处于启用状态：
    • 航前自检将失败（无论机体模式如何），在 COM_OBS_AVOID 设置为 0 之前，机体不会起飞。
  • 如果规划器均未运行并且 COM_OBS_AVOID 在启动后处于启用状态：
    • 机体将以手动方式正常运行。
    • 如果您切换到自动模式（例如着陆模式），机体将立即切回到 保持模式。
  • 当启用外部路径规划时：
    • 如果 HEARTBEAT 丢失，PX4 将会发出状态消息(显示在 QGroundControl 中)，声明“避障系统丢失”或“避障系统超时”（取决于机体状态）。 这项提醒与当前的飞行模式无关。
    • 如果超过 0.5 秒未收到轨迹信息并且机体处于自动模式（返航、任务、起飞、着陆），则无人机将切换到保持模式。 :::note 规划器必须在此时间段内始终提供航点信息。
    • 当无人机处于不提供路径规划的模式/状态时，规划器将镜像其接收到的设置航点。 （即无人机将沿着期望路径行驶，且延迟时间很小）。 :::
    • 如果上次提供的贝塞尔轨迹的执行时间在路径规划期间超时（当使用贝塞尔轨迹接口时），这将被视为在 0.5 秒内没有收到新消息（即无人机切换到保持模式）。

机载航点接口

路径规划软件（运行在机载计算机上）可以将计划的路径作为 TRAJECTORY_REPRESENTATION_BEZIER 消息流发送给 PX4。

来自机载计算机的消息字段设置如下：

  • time_usec: UNIX纪元时间戳
  • valid_points: 1
  • 当前飞机信息：
    • pos_x[0], pos_y[0], pos_z[0]: x-y-z NED坐标系下的载具位置设定值
    • vel_x[0], vel_y[0], vel_z[0]: x-y-z NED 坐标系下速度设定值
    • acc_x[0], acc_y[0], acc_z[0]: NaN
    • pos_yaw[0]: 航向角设定值
    • vel_yaw[0]: 偏航速率设定值
    • command[0]: NaN
  • 所有其它字段都是NaN(未定义)。

更详细地讲，TRAJECTORY_REPRESENTATION_BEZIER 被解析为：

  • 从 PX4 接收消息时，以超过 2Hz 的频率发出设定点。 如果超过 0.5 秒没有收到消息，PX4 将进入保持模式。
  • 当不支持对当前机体状态进行规划时，镜像回规划器收到的设定点值（例如，由于不支持着陆模式，局部路径规划器把安全着陆期间发送的信息镜像回去）。

机载贝塞尔曲线轨迹接口

路径规划软件（运行在机载计算机上）可以将计划的路径作为 TRAJECTORY_REPRESENTATION_BEZIER 消息流发送给 PX4。

消息定义了无人机应遵循的路径（由控制点定义），从消息 时间戳 开始，在时间 delta 后到达终点。 PX4 使用消息发送时间、当前时间和贝塞尔曲线的总时间（delta）计算其新的轨迹设定点（沿曲线趋势来预测的当前位置/速度/加速度）。

:::note 例如，消息是在 0.1秒前发送的， delta （曲线持续时间）是 0.3秒。 PX4 可以在曲线中以 0.1 秒间隔的精度计算其轨迹设定点。 :::

更详细地讲，TRAJECTORY_REPRESENTATION_BEZIER 被解析为：

  • 贝塞尔控制点的数目决定贝塞尔曲线的曲度。 例如，3个控制点可构成具有恒定加速度的二次贝塞尔曲线。
  • 贝塞尔曲线在 x、y、z 和偏航中的阶数必须相同，且所有贝塞尔控制点都是有限的。
  • 在delta 数组中，应保存与最后一个贝塞尔控制点相对应的值，表示在执行曲线过程中，从航点到该点所需的总计持续时间。 其他 delta 数组中的值将被忽略。
  • MAVLink 消息的时间戳应为曲线开始的时间，通信延迟和时钟不匹配将通过时间同步机制在飞行控制器上进行补偿。
  • 所有控制点都应该在局部坐标系中指定（MAV_FRAME_LOCAL_NED）。
  • 贝塞尔曲线在超过执行时间后将过期。 确保以足够高的速率/足够长的执行时间发送新消息，以免发生这种情况（否则机体将切换到保持模式）。

支持的硬件

测试过的机载计算机和相机列于 PX4/avoidance 中。