TNS: Terrain Traversability Mapping and Navigation System for Autonomous Excavators