Created new publishGraph function. Renamed publishCollisionTree to publishCollisionGraph