Added deleteAllMarkers, publishPath, publishSpheres, and convertPoseToPoint functions. Other small changes