visualizing urdf robot -- need to clean up and test