HuToFu Algorithm: Human description and topological map fusion