Robustness in environmental mapping is an important aspect of a computer vision system, but it is not emphasised by the current development of the technology in general. This thesis develops algorithms and approaches to enhance the robustness of simultaneous localisation and mapping systems and improve the accuracy of the mapping results.