vSSG = ssg(vAngles) vAngles = [fThetaSignal, fThetaPump, fPhiSignal, fPhiPump]; angles in rad the kI = kP - kS is assumed to minimize phase mismatch