#!/usr/bin/env python

# 12.2

import os, sys

sys.path += [os.getcwdu() + os.sep + ".." + os.sep + "python"]

import pylab as pl

from xdync import xdync

from polyfuncs import polmul

def gpc_bas(A, dA, B, dB, N, k, rho):

    D, dD = pl.array([1, -1]), 1

    AD, dAD = pl.convolve(A, D), dA+1

    Nu = N+1

    zj, dzj = 1, 0

    G = pl.zeros((Nu, 1))

    H1 = pl.zeros((Nu, k-1+dB))

    H2 = pl.zeros((Nu, dA+1))

    for j in range(Nu):

        zj = pl.convolve(zj, [0,1])

        dzj = dzj + 1

        Fj, dFj, Ej, dEj = xdync(zj, dzj, AD, dAD, 1, 0)[:4]

        Gj, dGj = polmul(B, dB, Ej, dEj)

        m, n = G.shape

        G = pl.column_stack((G, pl.zeros((m, dGj-n))))

        G[j, :dGj] = Gj[dGj-1::-1]

        H1[j,:k-1+dB] = Gj[dGj:dGj+k-1+dB]

        H2[j,:dA+1] = Fj

    K = pl.dot(pl.inv(pl.dot(G.T, G) + rho*pl.eye(Nu,Nu)), G.T)

    KH1 = pl.dot(K, H1)

    KH2 = pl.dot(K, H2)

    R1 = pl.concatenate(([1], KH1[0,:]))

    dR1 = len(R1)-1

    Sc = KH2[0,:]

    dSc = len(Sc)-1;

    Tc = K[0,:]

    dTc = len(Tc)-1;

    return K, KH1, KH2, Tc, dTc, Sc, dSc, R1, dR1