Added empty/size/add/remove methods for PathFinder