stopped using aron granbergs pathfinding and created my own still needs some bugs worked out