Tweaked path finding a bit.
Added a safety action delay check in the soldier loop.

Still no idea how that thing works.