Ok i've given up on Pathfinding, but on the upside the movements and collisions work right, and fast too. Also the AI now works the way i want minus pathfinding obviously. I have also tried making graphics too, i shall work hard to get a demo out in the next week, with real time combat. I can do it (i did it already in GM). And also to show off the engine itself.
