Skip to content
New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

Fix Pilz blending times (backport #2961) #3001

Open
wants to merge 4 commits into
base: iron
Choose a base branch
from

Conversation

mergify[bot]
Copy link

@mergify mergify bot commented Sep 14, 2024

Description

Found the issue!

Turns out that Pilz's appendWithStrictTimeIncrease() function had a single if-statement that encompassed two conditions:

  1. If trajectory is empty
  2. If the end state of one segment is not equal to the start state of the second segment

In both cases, the whole trajectory segment was appended with a dt=0.

The problem is that in case 1, it's appropriate to add a dt=0 (as the trajectory is empty, the first point should be at t=0). In case 2, we needed to apply a non-zero sample time offset dictated by the actual dt of that trajectory's first waypoint.

Closes #2945

Checklist

  • Required by CI: Code is auto formatted using clang-format
  • Extend the tutorials / documentation reference
  • Document API changes relevant to the user in the MIGRATION.md notes
  • Create tests, which fail without this PR reference
  • Include a screenshot if changing a GUI
  • 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 #2961 done by [Mergify](https://mergify.com).

* Fix Pilz blending times... the right way

* Remove more debugs

* Format

(cherry picked from commit 4fad0d0)

# Conflicts:
#	moveit_planners/pilz_industrial_motion_planner/src/command_list_manager.cpp
#	moveit_planners/pilz_industrial_motion_planner/src/trajectory_blender_transition_window.cpp
Copy link
Author

mergify bot commented Sep 14, 2024

Cherry-pick of 4fad0d0 has failed:

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

You are currently cherry-picking commit 4fad0d0de.
  (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/plan_components_builder.cpp

Unmerged paths:
  (use "git add <file>..." to mark resolution)
	both modified:   moveit_planners/pilz_industrial_motion_planner/src/command_list_manager.cpp
	both modified:   moveit_planners/pilz_industrial_motion_planner/src/trajectory_blender_transition_window.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

@mergify mergify bot added the conflicts label Sep 14, 2024
@sea-bass sea-bass changed the title Fix Pilz blending times... the right way (backport #2961) Fix Pilz blending times (backport #2961) Sep 14, 2024
@sea-bass
Copy link
Contributor

@henningkayser Iron CI seems to be not passing at the moment, could you help merge this backport? Thanks!

Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
None yet
Projects
None yet
Development

Successfully merging this pull request may close these issues.

2 participants