Added stats, fixed re-building point location problem, fixed lazy planner
Added stats, fixed re-building point location problem, fixed lazy planner

krishauser/KrisLibrary,krishauser/KrisLibrary,krishauser/KrisLibrary