路径规划接口

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

• 有两个 MAVLink 路径规划协议 (opens new window) 接口：
  • TRAJECTORY_REPRESENTATION_WAYPOINTS (opens new window): Used by PX4 to send the desired path. May be used by path planning software to send PX4 a stream of setpoints for the planned path.
  • TRAJECTORY_REPRESENTATION_BEZIER (opens new window) may (alternatively) be used by path planning software to send PX4 the planned path as a bezier curve. 曲线表示给定时间段内机体（移动的）位置设定值。
• HEARTBEAT（心跳包）/连接协议 (opens new window) 用于检测“生命证明”。
• LOCAL_POSITION_NED (opens new window) 和 ALTITUDE (opens new window) 分别用来发送机体本地位置和高度。

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

提示

The message flows from PX4 UORB topics, through MAVLink, to ROS and back again are all documented in: PX4/PX4-Avoidance > Message Flows (opens new window). 因此，开发者可以使用这个接口来创建自己新的机载计算机端路径规划服务，或调整现有的规划者软件。

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

注解

推荐使用 PX4 Vision Autonomy Development Kit 来开发路径规划软件。 It comes with PX4 avoidance (opens new window) software pre-installed, and can be used as the base for your own algorithms.

PX4 配置

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

机载计算机设置

Companion-side hardware setup and hardware/software configuration is provided in the PX4/PX4-Avoidance (opens new window) Github repo.

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

注意

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

轨迹接口

PX4 sends information about the desired path to the companion computer (when COM_OBS_AVOID=1, in auto modes), and receives back a stream of setpoints for the planned path from the path planning software.

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

Path planner software sends back setpoints for the planned path using either TRAJECTORY_REPRESENTATION_WAYPOINTS (see Companion Waypoint Interface) or TRAJECTORY_REPRESENTATION_BEZIER (opens new window) (see Companion Bezier Trajectory Interface). 不同之处在于，前者航点参数只是指定下一个设定的目标航点，而贝塞尔轨迹则描述精确的车辆运动（即随时间变化的设定点）。

注意

路由规划软件在执行任务时不应混用这些接口（PX4 将使用最近收到的任意类型的消息）。 因此，开发者可以使用这个接口来创建自己新的机载计算机端路径规划服务，或调整现有的规划者软件。

PX4 航点接口

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

PX4 中各字段定义如下：

• time_usec: UNIX 纪元时间戳
• valid_points: 3
• Point 0 - Current waypoint type adapted by FlightTaskAutoMapper (see notes below):
  • pos_x[0], pos_y[0], pos_z[0]: Type adapted x-y-z NED local position of current mission waypoint.
  • vel_x[0], vel_y[0], vel_z[0]: Type adapted x-y-z NED local velocity of current mission waypoint.
  • acc_x[0], acc_y[0], acc_z[0]: NaN
  • pos_yaw[0]: 当前航向角
  • vel_yaw[0]: NaN
  • command[0]: 当前航点的 MAVLink 命令 (opens new window)
• Point 1 - 当前航点（未修改/未调整类型）：
  • pos_x[1], pos_y[1], pos_z[1]: x-y-z NED local position of current mission waypoint
  • 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 命令 (opens new window)
• Point 2 - 局部坐标系中的下一个航点 (未修改/未调整类型)：
  • pos_x[2], pos_y[2], pos_z[2]: x-y-z NED local position of next mission waypoint
  • 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 命令 (opens new window)
• 所有其它字段都是NaN(未定义)。

路径规划软件（在机载计算机上运行）可以 以TRAJECTORY_REPRESENTATION_WAYPOINTS (opens new window) 消息流的形式发送所规划路径给 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 在启动后处于启用状态：
  • 机体将以手动方式正常运行。
  • 如果您切换到自动模式（例如着陆模式），机体将立即切回到 保持模式。
• 当启用外部路径规划时：
  • if the HEARTBEAT is lost PX4 will emit a status message (which is displayed in QGroundControl) stating either "Avoidance system lost" or "Avoidance system timeout" (depending on the vehicle state). 这项提醒与当前的飞行模式无关。
  • 如果超过 0.5 秒未收到轨迹信息并且机体处于自动模式（返航、任务、起飞、着陆），则无人机将切换到保持模式。 :::note 规划器必须在此时间段内始终提供航点信息。
  • 当无人机处于不提供路径规划的模式/状态时，规划器将镜像其接收到的设置航点。 （即无人机将沿着期望路径行驶，且延迟时间很小）。 因此，开发者可以使用这个接口来创建自己新的机载计算机端路径规划服务，或调整现有的规划者软件。
  • 如果上次提供的贝塞尔轨迹的执行时间在路径规划期间超时（当使用贝塞尔轨迹接口时），这将被视为在 0.5 秒内没有收到新消息（即无人机切换到保持模式）。

机载航点接口

The path planning software (running on the companion computer) may send the planned path to PX4 as a stream of TRAJECTORY_REPRESENTATION_WAYPOINTS (opens new window) messages that have the setpoint in Point 0.

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

• 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 将进入保持模式。
• 当不支持对当前机体状态进行规划时，镜像回规划器收到的设定点值（例如，由于不支持着陆模式，局部路径规划器把安全着陆期间发送的信息镜像回去）。

机载贝塞尔曲线轨迹接口

The path planning software (running on the companion computer) may send the planned path to PX4 as a stream of TRAJECTORY_REPRESENTATION_BEZIER (opens new window) messages.

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

注解

例如，消息是在 0.1秒前发送的， delta （曲线持续时间）是 0.3秒。 PX4 可以在曲线中以 0.1 秒间隔的精度计算其轨迹设定点。 因此，开发者可以使用这个接口来创建自己新的机载计算机端路径规划服务，或调整现有的规划者软件。

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

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

支持的硬件

Tested companion computers and cameras are listed in PX4/PX4-Avoidance (opens new window).