4 dof robot with ROS and Rviz