Trying code from sickRobotExample on robot