GRID-FAST: A Grid-based Intersection Detection for Fast Semantic Topometric Mapping