grid robot implementation with Smoothing and Mapping and Gridmapping