Skip to content

踩坑GitHub ros-planning/moveit214 天前

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

本文由 AI 根据公开内容整理,可能有误,请以原文为准:TOTG paths can contain extremely high accelerations(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 等,版权归原作者所有。

基于本页技术方向关联的整机参数、核心零部件、实测报告与同赛道选型横评。

外部来源

本页事实对应的公开页面,以原文为准。(点击将离开本站)

  1. GitHub ros-planning/moveit2 #3565:TOTG paths can contain extremely high accelerations ↗访问 2026-11-07