to help with pathfinding in my game the units are aranged int formations (using arrays.. thats something you need to learn) this means that the unit only has to do pathfinding one for a group of about 6-10 units then the units find thair way to the start of the path, walk it and then find their way to their position in the squad again.. like in Dawn of War ...