Add Rviz Marker for some conditions

[f0reachARR]

Description

Abstract

This PR will add Rviz Marker for ReachPositionCondition.

Background

Currently, interpreter does not expose its internal state for Rviz. However, there is a demand for showing state in Rviz for see internal state.

Details

For efficiency, I added VisualizationBuffer and collect all markers in it.
To share VisualizationBuffer across each Condition syntax processor, I use singleton for it (like SimulatorCore).

Example marker of ReachPositionCondition (red line for distance and green sphere for goal)

Known Limitations

As traffic_simulator and openscenario_interpreter are different package, distance line (red line between target position and current position) might not be accurate in case of using routing algorithm in distance calculation.

[github-actions]

Checklist for reviewers ☑️

All references to "You" in the following text refer to the code reviewer.

• Is this pull request written in a way that is easy to read from a third-party perspective?
• Is there sufficient information (background, purpose, specification, algorithm description, list of disruptive changes, and migration guide) in the description of this pull request?
• If this pull request contains a destructive change, does this pull request contain the migration guide?
• Labels of this pull request are valid?
• All unit tests/integration tests are included in this pull request? If you think adding test cases is unnecessary, please describe why and cross out this line.
• The documentation for this pull request is enough? If you think adding documents for this pull request is unnecessary, please describe why and cross out this line.

[sonarqubecloud]

Quality Gate passed

Issues
0 New issues
30 Accepted issues

Measures
0 Security Hotspots
0.0% Coverage on New Code
27.5% Duplication on New Code

See analysis details on SonarQube Cloud