Andrew's attempt at finishing the algorithm... not sure if correct. Does
not solve the sample input of just 5 vehicles in a reasonable amount of
time.