Worked on pathfinding a little more. Still very flawed.