summaryrefslogtreecommitdiff
path: root/modules/cacsd/macros/gtild.sci
blob: 037a532e93e63eac93258a3adca4b6986f4999a5 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
// Scilab ( http://www.scilab.org/ ) - This file is part of Scilab
// Copyright (C) INRIA -
//
// This file must be used under the terms of the CeCILL.
// This source file is licensed as described in the file COPYING, which
// you should have received as part of this distribution.  The terms
// are also available at
// http://www.cecill.info/licences/Licence_CeCILL_V2.1-en.txt

function Gt=gtild(G,flag)
    // input:
    // G(s): a polynomial matrix or a rational matrix
    // represented in state-space or in transfer form
    //
    // Gt=gtild(G) or  Gt=gtild(G,'c')
    // returns Gt = G(-s)' (in transfer form or in state-space)
    // for continuous time system G
    //or
    // Gt=gtild(G) or  Gt=gtild(G,'d')
    // returns Gt = z^n * G(1/z)' (n = maximum degree of G)
    // for discrete-time matrix polynomials
    //!

    [lhs,rhs]=argn(0)
    if rhs==1 then
        if typeof(G)=="rational"
            flag=G(4)
        elseif typeof(G)=="state-space"
            flag=G(7)
        elseif typeof(G)=="polynomial"
            flag=[]
        end
    end

    select typeof(G)
    case "polynomial"
        if flag=="c"
            Gt=cp_tilde(G);return;
        elseif flag=="d"
            Gt=dp_tilde(G);return;
        elseif flag==[]
            error(msprintf(gettext("%s: Wrong value for input argument #%d: Must be in the set {%s}.\n"),..
            "gtild",2,"''c'', ''d''"));
        end

    case "rational"
        v=varn([G(2),G(3)]);s=poly(0,v);
        if flag=="c"
            Gt=horner(G',-s);return;
        elseif flag=="d"
            Gt=horner(G',1/s);return;
        elseif flag==[]
            error(msprintf(gettext("%s: Wrong value for input argument #%d: Must be in the set {%s}.\n"),..
            "gtild",2,"''c'', ''d''"));
        end

    case "state-space"
        if flag==[] then dom=G(7);else dom=flag;end
        [A,B,C,D]=abcd(G);
        if dom=="c" then
            if typeof(D)=="polynomial"
                Dp=horner(D,-poly(0,varn(D)));
                Gt=syslin(dom,-A',-C',B',Dp');return;
            elseif typeof(D)=="constant"
                Gt=syslin(dom,-A',-C',B',D');return
            end
        elseif dom=="d"
            if typeof(G(5))=="polynomial"
                Dp=horner(D,1/poly(0,varn(D)));
                Dp=tf2ss(Dp);
                [A,B,C,D]=abcd(G');
                w=tlist(["des","A","B","C","D","E"],eye(A),B,C,0*C*B,A);
                z=poly(0,"z");zss=-tf2ss(z);zss(7)="d";
                Gt=zss*des2ss(w)+Dp';
            elseif typeof(G(5))=="constant"
                z=poly(0,"z");zss=-tf2ss(z);zss(7)="d";
                [A,B,C,D]=abcd(G');  //lazy way for transposition...
                w=tlist(["des","A","B","C","D","E"],eye(A),B,C,0*D,A);
                Gt=zss*des2ss(w)+D;   //-z*C*inv(I-z*A)*B + D
            end
        end
        //
    case "constant"
        Gt=G';return;
    end



endfunction
function mpt=dp_tilde(mp)
    //mp(z) =  polynomial matrix
    // mpt(i,j)= z^n*conj(mp(j,i))(1/z)
    [m,n]=size(mp),z=varn(mp)
    //max degree
    nmax=max(degree(mp));
    for i=1:m
        for j=1:n
            mpt(j,i)=poly(coeff(conj(mp(i,j)),nmax:-1:0),z,"c")
        end
    end

endfunction
function mpt=cp_tilde(mp)
    //mp(s) =  polynomial matrix
    // mpt(i,j)= conj(mp(j,i))(s)
    s=poly(0,varn(mp));
    pr=real(mp);pi=imag(mp);
    mpt=horner(pr',-s);
    if pi==0*s then return;end
    mpt=mpt+%i*horner(pi',-s);
endfunction