improved reachability grid initialization
improved reachability grid initialization

santosj/SpatioTemporalExploration,santosj/SpatioTemporalExploration,gestom/SpatioTemporalExploration,gestom/SpatioTemporalExploration,santosj/SpatioTemporalExploration,gestom/SpatioTemporalExploration