Find position of robot, C