Fixed some issues we had with new IM. No longer clamps results prematurely, and we now use the SO's position for querying the debug visualization rather than the unit's position.