Changed Pathfinding section to Movement section and refined architecture.
Fixed first part of pathfinding collision problem.
Fixed second part of pathfinding collision problem.