Working on a robot, need some help with the coding aspect