Added joint_state_controller, robot_state_publisher, Rviz support