added visualization of robot/vector position