I. Introduction
The problem of accurately localizing emergency response agents (civil security, firefighters, etc.), law enforcement or armed forces agents in a closed, unknown, non-cooperative environment remains an open problem nowadays, as well as mapping this environment. Many military and civil applications would benefit from such localization systems [1].