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

ros2: add curvature target marker #50

Merged

Conversation

srmainwaring
Copy link
Collaborator

@srmainwaring srmainwaring commented Feb 24, 2024

Add a marker to display the curvature target in addition to the position target. The length of the marker is the inverse curvature or turn radius. On straight segments the marker length is set to a small number (1.0E-6).

Figure: Curvature marker shown as red arrow. The path following is from an experimental implementation in ArduPilot, and needs some further tuning.
curvature_marker

@Jaeyoung-Lim
Copy link
Member

@srmainwaring The closest point calculation still seems off on the last green segment. Do you know why the closest point is not on the path?

@srmainwaring
Copy link
Collaborator Author

The closest point calculation still seems off on the last green segment. Do you know why the closest point is not on the path?

Didn't spot that, but you're correct. Not sure. Will need to look into that. Maybe the tolerance needs to be tighter with a smaller turn radius?

- Add marker and publish to /curvature_target.
- Correct curvature marker direction.
- Add curvature marker to rviz config.
- Fix code style.

Signed-off-by: Rhys Mainwaring <[email protected]>
@Jaeyoung-Lim
Copy link
Member

@srmainwaring Is this visible when we keep the minimum turn radius as before? Wondering if there is something hardcoded in hiding...

@srmainwaring
Copy link
Collaborator Author

srmainwaring commented Feb 24, 2024

@Jaeyoung-Lim, No. When I set the turn radius back to 80m I don't see the position target cutting across the turn. The behaviour is not linked to this PR, but the marker does help highlight the issue.

@Jaeyoung-Lim Jaeyoung-Lim merged commit 380c29d into ethz-asl:ros2 Feb 24, 2024
3 checks passed
@srmainwaring srmainwaring deleted the prs/pr-add-curvature-marker branch February 24, 2024 19:59
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