The code for "A Navigation Algorithm inspired by Human Navigation"