bug fix related to RxSO3/Sim3 Map & further polishing