Centralize force sensor bias correct.

I was doing the same thing in two different places. Better to define a
routine to do it so that it's always consistent.
WaitDesiredForce(), WaitSlip()