Skip to content

多旋翼的加加速度限制型轨迹

加加速度有限的轨迹类型能响应用户摇杆输入或任务的变化(例如:航拍,测绘,货运)并为机体提供平滑的运动。 它能产生对称的平滑 S-曲线使加加速度和加速度的极限始终得到保证。

此轨迹类型始终在任务模式下启用。 To enable it in Position mode set the parameter: MPC_POS_MODE=3.

The jerk-limited type is not used by default in position mode. 但它可能不适合于那些需要较快响应的机体/使用案例——例如穿越机。

轨迹生成器

下图显示了具有如下约束的典型加加速度限制剖面:

  • jMax:最大抖动
  • a0:初始加速度
  • aMax:最大加速度
  • a3:最终加速度(始终为 0)
  • v0:初始速度
  • vRef:期望速度

其中,约束 jMaxaMax 由用户通过参数页配置,在手动定点控制和自动模式下可能有所不同。

所得的速度剖面通常称为“S-曲线”。

加加速度限制型轨迹

手动模式

In manual position mode, the sticks are mapped to velocity where a full XY-stick deflection corresponds to MPC_VEL_MANUAL and a full Z-stick deflection corresponds to MPC_Z_VEL_MAX_UP (upward motion) or MPC_Z_VEL_MAX_DN (downward motion).

约束

XY平面:

Z轴:

自动模式

In auto mode, the desired velocity is MPC_XY_CRUISE but this value is automatically adjusted depending on the distance to the next waypoint, the maximum possible velocity in the waypoint and the maximum desired acceleration and jerk. The vertical speed is defined by MPC_Z_V_AUTO_UP (upward motion) and MPC_Z_V_AUTO_DN (downward motion).

约束

XY平面:

Z轴:

渐进某个航点时的距离-速度增益:

相关参数