Added localization, re worked and upgraded navigation and save history algorithm.