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

Add toppra plugin code structure #24

Merged
merged 17 commits into from
Aug 7, 2024
Merged

Conversation

sjahr
Copy link
Contributor

@sjahr sjahr commented Jul 24, 2024

First iteration on the toppra plugin. Implements the plugin + adds conversation functions between drake and moveit classes. At the moment toppra is not able to solve the problems given by the demo. I'd like to fix that in a follow-up PR and maybe you spot something in your review that might cause the issue.

Once TOPPRA is working, I'll also clean-up the spaghetti code in the main plugin file 😅

@sjahr sjahr marked this pull request as ready for review August 6, 2024 07:18
@sjahr sjahr requested a review from sea-bass August 6, 2024 07:20
@sjahr
Copy link
Contributor Author

sjahr commented Aug 6, 2024

@kamiradi I cannot tag you as a reviewer but do you mind reviewing this PR?

@sjahr sjahr changed the title [WIP] Add toppra plugin Add toppra plugin code structure Aug 6, 2024
Copy link
Contributor

@sea-bass sea-bass left a comment

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

Code-wise, not much to say.

I can test later, but the usage of TOPPRA looks exactly as per the Drake documentation 🤷🏻

demo/src/pipeline_testbench_main.cpp Outdated Show resolved Hide resolved
include/moveit/drake/conversions.hpp Outdated Show resolved Hide resolved
include/moveit/drake/conversions.hpp Outdated Show resolved Hide resolved
include/moveit/drake/conversions.hpp Outdated Show resolved Hide resolved
plugin_descriptions.xml Outdated Show resolved Hide resolved
src/add_toppra_time_parameterization.cpp Outdated Show resolved Hide resolved
auto toppra = Toppra(input_trajectory, plant, grid_points);

/////////////////////////////////////////////////////////////////////////
// Read joint bounds from robot model (TODO(sjahr): Expose in MoveIt2) //
Copy link
Contributor Author

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

@kamiradi FYI:This is how you can read the joint limits

Copy link
Contributor

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

Might be good to put this in a utility function to share between TOPPRA and KTOpt (and whatever else comes next)

Copy link
Contributor Author

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

I'll add that to moveit

Copy link
Contributor

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

Cool! Might be useful in MoveIt Servo as well since I recall having to write similar code there.

@sjahr sjahr requested a review from sea-bass August 6, 2024 19:46
@sjahr sjahr merged commit 14cf1e3 into moveit:main Aug 7, 2024
2 checks passed
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