Added occupancy grid utils submodule