Tweaked goToLocation to avoid moving back and forth between squares until blocked by another soldier.