踩坑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精度浮点运算环境
解决办法
- 在
Trajectory::create()末尾遍历轨迹点,剔除与前一点时间差小于epsilon的冗余段,防止除零溢出(注意此法不保证严格满足加速度限幅)。 - 排查正反向曲线拼接处的速度跳变源,确保合并点运动学连续性以从根本上解决超限问题。
- 增强
getPosition/getVelocity/getAcceleration对零time_step及首段边界的防御性处理。 - 添加基于hexfloat输入的回归测试,验证采样加速度是否严格保持在设定限值内。
讨论原作者:@Eruvae 等,版权归原作者所有。
外部来源
本页事实对应的公开页面,以原文为准。(点击将离开本站)