Changes made for Pathfinder 5226 controllers.

The target position of the backgauge can change if the main backstop is not the backstop that is going to be used for that operation. This can mean a finger or closed grippers used for gauging. In these cases the backgauge needs to be offset to account for the length of the finger or grippers when closed. There was a bug where the target direction was being decided by the original target instead of the offset position of where the backgauge is actually moving to.

The solution was to make sure the new target that was calculated is used for deciding target direction for that move.