Just small bug fixing. Few bugs of pathfinder algorithm were fixed.