Added new MoveIt robot state functionality. Added visualize grasp functionality