Finding and dispatching nearest vehicle is working for the trivial cases. Need to test further