Tuned PID values, added joint state publisher and robot state publisher