made several changes; added PoseStamped publishers; added functionality for joint state publisher fir visualization in RViz