Update RobotPathFinder.java