mpc/gpc_bas.py
changeset 0 0efde00f9229
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/mpc/gpc_bas.py	Fri May 27 14:24:59 2011 +0530
@@ -0,0 +1,41 @@
+#!/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