added Enrico's GA (VRP), move robot with ray and Astar