[Jazzy] Optimize MPPI visualization to skip processing when no subscribers#5807

SteveMacenski merged 2 commits intoros-navigation:jazzyros-navigation/navigation2:jazzyfrom

SatArw:feature/reduce_mppi_vis_load_jazzySatArw/navigation2:feature/reduce_mppi_vis_load_jazzyCopy head branch name to clipboard