Adding the visualization of robot's executed path