Path finding for the vector race game (very naive and simple, just playing around)