Add Inflation to the grid_map height data

[Marwan99]

Mimic the inflation behavior being done in costmap_2D to get a similar effect.

The aim is to avoid the rover going over edges of hills or valleys.