from math import pi, sin, cos, sqrt

## def sqr (x):
##     return x * x

eps = 1.0e-7

class FNyquistPulse (object):
    """Full nyquist (raised cosine) pulse response"""
    def __init__ (self, alpha, scale=1, deltaT=0, T=1):
        self.alpha = alpha
        self.scale = scale
        self.deltaT = deltaT
        self.T = T

    def __call__ (self, t):
        """
        pulse response at time t
        :param `t`: time (symbols)
        """
        t += self.deltaT
        if (t > -eps and t < eps):
            return (self.scale * 1.0)
        else:
            x = t/self.T
            den = (1. - (2. * self.alpha * x)**2) * pi * x
            if (den > -eps and den < eps):
                return self.scale * self.alpha/2. * sin (pi / (2 * self.alpha))
            else:
                num = cos(pi * self.alpha * x) * sin (pi * x)
                return self.scale * num / den;

class RNyquistPulse (object):
    """Root raise cosine repsonse"""
    def __init__ (self, alpha, scale=1, deltaT=0, T=1):
        self.alpha = alpha
        self.scale = scale
        self.deltaT = deltaT
        self.T = T

    def __call__ (self, t):
        """
        pulse response at time t
        :param `t`: time (symbols)
        """
        t += self.deltaT
        sqrtT = sqrt (self.T)
        if (abs(t) < eps):
            return self.scale * ((4*self.alpha/pi) + 1 - self.alpha)/sqrtT
        else:
            x = t/self.T
            if (self.alpha == 0.0):
                return self.scale * sqrtT * sin( pi * x)/(pi * t)
            else:
                oneplus = (1.0+self.alpha)*pi/self.T
                oneminus = (1.0-self.alpha)*pi/self.T;
                ## Check to see whether we will get divide by zero
                den = (t*4*self.alpha)**2 - (self.T)**2
                if (den > -eps and den < eps):
                    return self.scale * (self.T * sqrtT/(8 * self.alpha * pi * t)) * (oneplus * sin( oneplus * t) - (oneminus*self.T/(4*self.alpha*t)) * cos (oneminus * t) + (self.T/(4*self.alpha*t*t)) * sin (oneminus * t))
                else:
                    return self.scale * (4*self.alpha/(pi*sqrtT)) * (cos(oneplus*t) + sin(oneminus*t)/(x*4*self.alpha)) / (1.0 - 16*self.alpha*self.alpha*x*x)

if (__name__ == "__main__"):
    import sys
    sys.path.append ('../mod')
    from nyquist import RNyquistPulse

    from uvector import vector_double

    def CreatePulse (p, SPS, SI):
        size = SPS*SI+1
        out = vector_double (size)
        center = (SPS * SI)/2

        for i in xrange (SPS*SI+1):
            out[i] =  p ((float(i) - center) / float(SPS) + 0.5/SPS)

        return out

    SPS=16
    SI=4
    u = CreatePulse (RNyquistPulse (0.5), SPS, SI)

    for e in u:
        print (e)

