change so can move back to starting point, fix bug so can now turn around if algorithm show its a better path