Add ScenePublisher for composite robots
Update CMakeLists.txt
Fix bug regarding robotConfig in scene_publisher
Fix bug regarding planar joint.
Merge pull request #10 from billx09/master

Fix bug in ScenePublisher