Added the visualization of the robot com in addition to node coms