Wait, pathfinding? IMPOSSIBLE!
It will need some more work, but units won't walk intowalls and other objects.