Moved all robot path calculations to the drawpath function of the robot class