Changed robot urdf to one from ROS tutorials.
Working on setting it up to work.