fix bug on gridmap