fixed quick bug
finish new pathfinding algo