-
Notifications
You must be signed in to change notification settings - Fork 9
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
Conversation
@kamiradi I cannot tag you as a reviewer but do you mind reviewing this PR? |
There was a problem hiding this 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 🤷🏻
auto toppra = Toppra(input_trajectory, plant, grid_points); | ||
|
||
///////////////////////////////////////////////////////////////////////// | ||
// Read joint bounds from robot model (TODO(sjahr): Expose in MoveIt2) // |
There was a problem hiding this comment.
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
There was a problem hiding this comment.
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)
There was a problem hiding this comment.
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
There was a problem hiding this comment.
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.
Co-authored-by: Sebastian Castro <[email protected]>
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 😅