Started Fixing SaturationStateGivenDelta

Major re-write of underlying back-calculation algorithm.  Re-write is
for speed, maintainability, robustness, and (most importantly)
correctness.