SLAM approach based on truncated signed distance transform