Autonomous navigation is a crucial technology that helps a mobile robot to move independently and navigating through unknown areas that are impossible for human to venture due to limitation of physical abilities or even danger that may threaten life. By solving a maze, the algorithms and behaviour of the robot can be studied and improved. This paper describes the development of algorithm for improved maze navigation and it is a continuation on a previous project. Detection of walls and opening in the maze were accomplished using ultrasonic range-finders. The robot will be able to learn the maze, find all possible routes and solve it using the shortest one