Add support for prismatic joints.
Changed std::cout with ROS_DEBUG (note that some of these debug messages should be completely removed eventually).
Fixed indentation with Eclipse.