Only publish debug map if subscriber exists
Removed debug marker publishing
Added path markers to simulation