Enhancement/ports moveit 3522 (backport #3070)

[mergify]

Description

Ports moveit/moveit#3522 to moveit2. Should fix #2857

Checklist

• Required by CI: Code is auto formatted using clang-format
• Extend the tutorials / documentation reference (fixes bug)
• Document API changes relevant to the user in the MIGRATION.md notes (fixes bug)
• Create tests, which fail without this PR reference
• Include a screenshot if changing a GUI (No GUI changes)
• While waiting for someone to review your request, please help review another open pull request to support the maintainers

---

This is an automatic backport of pull request #3070 done by [Mergify](https://mergify.com).

[mergify]

Cherry-pick of 4c28a74 has failed:

On branch mergify/bp/iron/pr-3070
Your branch is up to date with 'origin/iron'.

You are currently cherry-picking commit 4c28a7434.
  (fix conflicts and run "git cherry-pick --continue")
  (use "git cherry-pick --skip" to skip this patch)
  (use "git cherry-pick --abort" to cancel the cherry-pick operation)

Changes to be committed:
	modified:   moveit_planners/pilz_industrial_motion_planner/src/trajectory_generator_ptp.cpp

Unmerged paths:
  (use "git add <file>..." to mark resolution)
	both modified:   moveit_planners/pilz_industrial_motion_planner/src/trajectory_generator_circ.cpp
	both modified:   moveit_planners/pilz_industrial_motion_planner/src/trajectory_generator_lin.cpp

To fix up this pull request, you can check it out locally. See documentation: https://docs.github.com/en/pull-requests/collaborating-with-pull-requests/reviewing-changes-in-pull-requests/checking-out-pull-requests-locally