Wrote tests for grid streetmap simulation.

Signed-off-by: Ted Steiner <tsteiner2@gmail.com>