Feature request

Feature description

MPPI Controller debug flag at the moment shows, spheres for candidate points, can this be visualized as LINE Markers instead of sphere markers to make it more intuitive.

Implementation considerations

REfactoring of trajectory_visualizer.cpp in Nav2_MPPI_CONTROLLER, I am willing to work on this.