Mapping and costruction of occupancy grid map