Added the intial node to the openlist, bug resolved
Added the intial node to the openlist, bug resolved