Elevation Mapping – Robot-centric elevation mapping for rough terrain navigation