Shortened findLineBoundSize, added occupancy grid utils headers