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

Xtk motion velocity planner diag #1471

Closed
wants to merge 6 commits into from

Conversation

xtk8532704
Copy link

Description

This PR adds a publisher in motion_velocity_planner to publish diagnostics as what this PR did for cruise_planner.

The published diagnostics contain information that shows which module (DynamicObstacleStopModule; OutOfLaneModule; ObstacleVelocityLimiterModule) made what decision (stop; slow_down). An example is as follows:

$ ros2 topic echo /diagnostics
---
header:
  stamp:
    sec: 1723713886
    nanosec: 559327470
  frame_id: map
status:
- level: "\0"
  name: autoware::motion_velocity_planner::OutOfLaneModule.stop
  message: ''
  hardware_id: ''
  values:
  - key: decision
    value: none
- level: "\0"
  name: autoware::motion_velocity_planner::OutOfLaneModule.slow_down
  message: ''
  hardware_id: ''
  values:
  - key: decision
    value: autoware::motion_velocity_planner::OutOfLaneModule.slow_down
- level: "\0"
  name: autoware::motion_velocity_planner::ObstacleVelocityLimiterModule.stop
  message: ''
  hardware_id: ''
  values:
  - key: decision
    value: none
- level: "\0"
  name: autoware::motion_velocity_planner::ObstacleVelocityLimiterModule.slow_down
  message: ''
  hardware_id: ''
  values:
  - key: decision
    value: none
- level: "\0"
  name: autoware::motion_velocity_planner::DynamicObstacleStopModule.stop
  message: ''
  hardware_id: ''
  values:
  - key: decision
    value: none
- level: "\0"
  name: autoware::motion_velocity_planner::DynamicObstacleStopModule.slow_down
  message: ''
  hardware_id: ''
  values:
  - key: decision
    value: none
---

the decision info in diags will be used by planning evaluator.

Related links

Parent Issue:

  • Link

How was this PR tested?

Screencast.from.2024.08.15.18.24.11.webm

Notes for reviewers

None.

Interface changes

None.

Effects on system behavior

None.

Signed-off-by: xtk8532704 <[email protected]>
Signed-off-by: xtk8532704 <[email protected]>
Signed-off-by: xtk8532704 <[email protected]>
Signed-off-by: xtk8532704 <[email protected]>
Copy link

Thank you for contributing to the Autoware project!

🚧 If your pull request is in progress, switch it to draft mode.

Please ensure:

@xtk8532704 xtk8532704 closed this Aug 16, 2024
Copy link

sonarcloud bot commented Aug 16, 2024

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

Successfully merging this pull request may close these issues.

1 participant