Routeplanner of the robot