# MoveIt2 TOTG生成轨迹含极高加速度致超限

> 原文链接：https://robotics.hellobike.com/pitfalls/2026-11-07-moveit2-3565
> 频道：pitfalls | 更新日期：2026-11-07 | 标签：auto, github-issue, moveit2
> 核心摘要：TOTG算法因正反向曲线拼接处时间步长趋近零导致加速度计算溢出，可通过剔除微小时间间隔点或修复速度跳变绕过。

# MoveIt2 TOTG生成轨迹含极高加速度致超限

::: v-pre
> 本文由 AI 根据公开内容整理，可能有误，请以原文为准：[TOTG paths can contain extremely high accelerations](https://github.com/moveit/moveit2/issues/3565)（GitHub ros-planning/moveit2 #3565）

**状态**：有绕过办法

## 问题

MoveIt2的TOTG轨迹生成器偶发返回含极高加速度的路径。根因是`integrateBackward()`拼接时产生几乎相同时间戳的轨迹段，导致`getAcceleration`中`time_step`接近double最小值(2.22045e-16)，除法运算引发数值溢出。该问题仅在特定hexfloat输入下复现，且简单剔除微小时间段后仍可能违反最大加速度约束。

## 环境

MoveIt2 (moveit_core/trajectory_processing), time_optimal_trajectory_generation.cpp, C++ double精度浮点运算环境

## 解决办法

1. 在`Trajectory::create()`末尾遍历轨迹点，剔除与前一点时间差小于epsilon的冗余段，防止除零溢出（注意此法不保证严格满足加速度限幅）。
2. 排查正反向曲线拼接处的速度跳变源，确保合并点运动学连续性以从根本上解决超限问题。
3. 增强`getPosition`/`getVelocity`/`getAcceleration`对零`time_step`及首段边界的防御性处理。
4. 添加基于hexfloat输入的回归测试，验证采样加速度是否严格保持在设定限值内。

讨论原作者：@Eruvae 等，版权归原作者所有。
:::

## 原始参考来源 (Sources)

- [GitHub ros-planning/moveit2 #3565：TOTG paths can contain extremely high accelerations](https://github.com/moveit/moveit2/issues/3565)