Added ros publishers and set them up in the navigator constructor. Started a function to publish the topics. It is commented out and needs to be finished.
Fixed conflicts after adding publishers