orthoInterp code works, converges fast