Correct referente to obstacle map
Correct sync with obstacle map and visual map
Adjust indexes
Show obstacle map and visual map for comparation