#!/usr/bin/python
# 9.8
import os, sys
sys.path += [os.getcwdu() + os.sep + ".." + os.sep + "python"]

import scipy as sp
from polyfuncs import polmul
from zpowk import zpowk
from xdync import xdync

def pp_pid(B, A, k, phi, Delta):
    Delta = sp.atleast_1d(Delta)
    B = sp.atleast_1d(B)
    # Setting up and solving Aryabhatta identity
    dA = len(A) - 1
    dB = len(B) - 1
    
    zk, dzk = zpowk(k)
    
    N, dN = polmul(B, dB, zk, dzk)
    dDelta = len(Delta)-1
    D, dD = polmul(A, dA, Delta, dDelta)
    dphi = len(phi)-1
    
    Sc, dSc, R, dR = xdync(N, dN, D, dD, phi, dphi)[:4]

    R = sp.squeeze(R)
    Rc = sp.convolve(R, Delta)

    return Rc, Sc

if __name__ == "__main__":
    Ts = 1
    B = 0.63
    A = sp.array([1, -0.37])
    k = 1

    zk, dzk = zpowk(k)
        
    phi = sp.array([1, -0.5])
    delta = 1
        
    print pp_pid(B, A, k, phi, delta)