Video of first attempt at pathfinding in action



Obviously ignore the basic models, textures, animations, etc - it's the AI not walking into walls which is the important thing here.