0
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 1 % cpsdForCorrelatedInputs computes the output theoretical CPSD shape with given inputs.
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 2 %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 3 %
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 4 % DESCRIPTION: cpsdForCorrelatedInputs computes the output theoretical CPSD
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 5 % or PSD shape with given inputs.
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 6 % It returns summed and contributions only and takes
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 7 % input arrays of objects (instead of vectors)
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 8 %
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 9 % CALL: [mat_out] = CPSD(sys, pl)
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 10 %
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 11 % INPUTS:
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 12 % - sys, (array of) ssm object
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 13 %
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 14 % OUTPUTS:
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 15 % _ mat_out contains specified returned aos
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 16 %
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 17 % <a href="matlab:utils.helper.displayMethodInfo('ssm', 'cpsdForCorrelatedInputs')">Parameters Description</a>
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 18 %
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 19 % VERSION: $Id: cpsdForCorrelatedInputs.m,v 1.2 2011/05/23 14:18:20 adrien Exp $
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 20 %
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 21 %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 22
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 23 function varargout = cpsdForCorrelatedInputs(varargin)
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 24
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 25 %% starting initial checks
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 26
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 27 % use the caller is method flag
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 28 callerIsMethod = utils.helper.callerIsMethod;
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 29
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 30 % Check if this is a call for parameters
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 31 if utils.helper.isinfocall(varargin{:})
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 32 varargout{1} = getInfo(varargin{3});
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 33 return
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 34 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 35
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 36 utils.helper.msg(utils.const.msg.MNAME, ['running ', mfilename]);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 37
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 38 % Collect input variable names
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 39 in_names = cell(size(varargin));
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 40 for ii = 1:nargin,in_names{ii} = inputname(ii);end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 41
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 42 % Collect all SSMs and plists
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 43 [sys, ssm_invars, rest] = utils.helper.collect_objects(varargin(:), 'ssm', in_names);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 44 [pl, invars2, rest] = utils.helper.collect_objects(rest(:), 'plist');
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 45 if ~isempty(rest)
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 46 pl = combine(pl, plist(rest{:}));
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 47 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 48 pl = combine(pl, getDefaultPlist());
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 49
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 50 %%% Internal call: Only one object + don't look for a plist
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 51 internal = strcmp(varargin{end}, 'internal');
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 52
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 53 %% begin function body
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 54
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 55 %% retrieve system infos
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 56
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 57 if numel(sys)~=1
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 58 error('noisespectrum needs exactly one ssm as an input')
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 59 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 60 if ~sys.isnumerical
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 61 error(['error because system ',sys.name,' is not numerical']);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 62 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 63 if ~sys.isStable
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 64 error('input ssm is not stable!')
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 65 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 66 if sys.timestep==0
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 67 timestep = 1;
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 68 else
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 69 timestep = sys.timestep;
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 70 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 71 if ~internal
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 72 inhist = sys.hist;
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 73 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 74
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 75 %% modifying system's ordering
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 76 if find(pl, 'reorganize')
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 77 sys = reorganize(sys, pl, 'set', 'for cpsdForCorrelatedInputs', 'internal', 'internal');
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 78 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 79
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 80 %% collecting functions i/o data
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 81 aos_in = find(pl, 'aos');
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 82 PZ_in = find(pl, 'PZmodels');
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 83 cov_in = find(pl, 'covariance');
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 84 cpsd_in = find(pl, 'CPSD');
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 85 noise_in = blkdiag(cov_in, cpsd_in/(timestep*2));
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 86 powWhiteNoise = noise_in;
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 87 [U1,S1,V1] = svd(noise_in.'); % testing hermitian symmetry and definite positiveness
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 88 if (sum(S1<0)>0)
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 89 error('covariance/cpsd matrix is not positive')
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 90 elseif norm(U1-V1')>1e-15*sqrt(numel(U1))
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 91 error('covariance/cpsd matrix is not hermitian symmetric')
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 92 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 93
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 94 %% getting system's i/o sizes
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 95 inputSizes = sys.inputsizes;
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 96 outputSizes = sys.outputsizes; %#ok<NASGU>
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 97
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 98 Naos_in = inputSizes(1);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 99 NPZmodels = inputSizes(3);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 100
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 101 %% retrieving frequency vector
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 102 if isempty(Naos_in)==0
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 103 f1 = find(pl,'f1');
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 104 f2 = find(pl,'f2');
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 105 NFreqs = find(pl,'nf');
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 106 if isempty(f1) || isempty(f2)|| isempty(NFreqs)
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 107 error('### Please specify frequency vector a start and stop frequency .');
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 108 else
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 109 freqs = 10.^linspace(log10(f1), log10(f2), NFreqs);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 110 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 111 else
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 112 freqs = aos_in(1).x;
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 113 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 114
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 115 %% checking frequency vector
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 116 for i=2:numel(aos_in)
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 117 if ~isequal(freqs,aos_in(i).x)
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 118 error('there exist different frequency vectors');
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 119 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 120 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 121
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 122 %% reshape pzmodels and aos for input cross-spectra
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 123 if size(PZ_in,1)==NPZmodels
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 124 PZdata = zeros(Npzmodels,Npzmodels,NFreqs);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 125 for i=1:NPZmodels
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 126 for j=1:Npzmodels
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 127 a = resp(PZ_in(i,j), freqs);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 128 PZdata(i,j,:) = reshape(a.y,[1,NFreqs]) ;
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 129 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 130 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 131 else
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 132 error('Wrong size for field PZ_in')
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 133 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 134
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 135 if size(aos_in,1)==Naos_in && size(aos_in,2)==Naos_in
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 136 AOdata = zeros(Naos_in,Naos_in,NFreqs);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 137 for i=1:Naos_in
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 138 for j=1:Naos_in
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 139 AOdata(i,j,:) = reshape(aos_in(i,j).y,[1,NFreqs]) ;
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 140 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 141 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 142 else
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 143 error('Wrong size for field aos_in')
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 144 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 145
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 146 %% SSM Transfer function
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 147 [a, b, c, d, Ts, InputName, StateName, OutputName,...
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 148 inputvarunits, ssvarunits, outputvarunits] = double(sys); %#ok<ASGLU>
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 149 resps = ssm.doBode(a, b, c, d, 2*pi*freqs, Ts);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 150 Noutputs = numel(OutputName);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 151
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 152 %% power for each frequency with SVD computation
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 153 diagOnly = pl.find('DIAGONAL ONLY');
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 154 if diagOnly
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 155 Result = zeros(Noutputs,NFreqs);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 156 else
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 157 Result = zeros(Noutputs,Noutputs,NFreqs);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 158 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 159
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 160 for i_freq=1:NFreqs
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 161 %% contribution from aos, testing positiveness
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 162 powAO = squeeze(AOdata(:,:,i_freq));
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 163 [U1,S1,V1] = svd(powAO.'); % testing hermitian symmetry and definite positiveness
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 164 if (sum(S1<0)>0)
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 165 error('AO covariance matrix is not positive')
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 166 elseif norm(U1-V1')>1e-15*sqrt(numel(U1))
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 167 error('AO covariance matrix is not hermitian symmetric')
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 168 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 169 %% contribution from PZmodels, testing positiveness
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 170 tfPZ = squeeze(PZdata(:,:,i_freq));
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 171 powPZ = tfPZ * tfPZ';
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 172 %% summing all three contributions sources, computing CPSD
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 173 pow = blkdiag(powAO, powWhiteNoise, powPZ);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 174 RespLoc = squeeze(resps(:,:,i_freq));
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 175 noise = RespLoc * pow * RespLoc' * (2*timestep) ;
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 176 if diagOnly
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 177 Result(:,i_freq) = real(diag(noise)) ;
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 178 else
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 179 Result(:,:,i_freq) = noise ;
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 180 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 181 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 182
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 183 %% saving in aos
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 184 if diagOnly % making a psd only
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 185 ao_out = ao.initObjectWithSize(Noutputs, 1);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 186 for io=1:Noutputs
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 187 ao_out(io).setData(fsdata(freqs, squeeze(Result(io,:)) ));
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 188 ao_out(io).setName( ['PSD of ' , OutputName{io}]);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 189 ao_out(io).setXunits('Hz');
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 190 ao_out(io).setYunits(outputvarunits(io)*outputvarunits(io)/unit('Hz'));
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 191 ao_out(io).setDescription( ['PSD of ' , OutputName{io}]);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 192 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 193 else % making a cpsd matrix
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 194 ao_out = ao.initObjectWithSize(Noutputs, Noutputs);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 195 for io=1:Noutputs
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 196 for jo=1:Noutputs
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 197 ao_out(io,jo).setData(fsdata(freqs, squeeze(Result(jo,io,:)) ));
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 198 ao_out(io,jo).setXunits('Hz');
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 199 ao_out(io,jo).setYunits(outputvarunits(io)*outputvarunits(jo)/unit('Hz'));
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 200 if io~=jo
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 201 ao_out(io,jo).setName( ['Cross PSD of ', OutputName{jo}, ' and ', OutputName{io}]);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 202 ao_out(io,jo).setDescription( ['Cross PSD of ', OutputName{jo}, ' and ', OutputName{io}]);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 203 else
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 204 ao_out(io,jo).setName( ['PSD of ' , OutputName{jo}]);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 205 ao_out(io,jo).setDescription( ['PSD of ' , OutputName{jo}]);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 206 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 207 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 208 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 209 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 210
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 211 %% construct output matrix object
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 212 out = matrix(ao_out);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 213 if callerIsMethod
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 214 % do nothing
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 215 else
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 216 myinfo = getInfo('None');
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 217 out.addHistory(myinfo, pl , ssm_invars(1), inhist );
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 218 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 219
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 220 %% Set output depending on nargout
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 221 if nargout == 1;
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 222 varargout = {out};
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 223 elseif nargout == 0;
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 224 iplot(ao_out);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 225 else
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 226 error('Wrong number of outputs')
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 227 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 228 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 229
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 230
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 231 %--------------------------------------------------------------------------
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 232 % Get Info Object
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 233 %--------------------------------------------------------------------------
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 234 function ii = getInfo(varargin)
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 235
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 236 if nargin == 1 && strcmpi(varargin{1}, 'None')
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 237 sets = {};
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 238 pl = [];
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 239 else
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 240 sets = {'Default'};
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 241 pl = getDefaultPlist;
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 242 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 243 % Build info object
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 244 ii = minfo(mfilename, 'ssm', 'ltpda', utils.const.categories.op, '$Id: cpsdForCorrelatedInputs.m,v 1.2 2011/05/23 14:18:20 adrien Exp $', sets, pl);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 245
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 246 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 247
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 248 %--------------------------------------------------------------------------
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 249 % Get Default Plist
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 250 %--------------------------------------------------------------------------
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 251 function pl = getDefaultPlist()
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 252 pl = ssm.getInfo('reorganize', 'for cpsdForCorrelatedInputs').plists;
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 253 pl.remove('set');
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 254
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 255 p = param({'covariance', 'The covariance matrix of this noise between input ports for the <i>time-discrete</i> noise model.'}, []);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 256 pl.append(p);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 257
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 258 p = param({'CPSD', 'The one sided cpsd matrix of the white noise between input ports.'}, []);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 259 pl.append(p);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 260
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 261 p = param({'aos', 'An array of input AOs, provides the cpsd of the input noise.'}, ao.initObjectWithSize(1,0));
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 262 pl.append(p);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 263
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 264 p = param({'PZmodels', 'An array of input pzmodels, used to filter the input noise.'}, paramValue.DOUBLE_VALUE(zeros(0,1)));
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 265 pl.append(p);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 266
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 267 p = param({'reorganize', 'When set to 0, this means the ssm does not need be modified to match the requested i/o. Faster but dangerous!'}, paramValue.TRUE_FALSE);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 268 pl.append(p);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 269
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 270 p = param({'f2', 'The maximum frequency. Default is Nyquist or 1Hz.'}, paramValue.EMPTY_DOUBLE);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 271 pl.append(p);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 272
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 273 p = param({'f1', 'The minimum frequency. Default is f2*1e-5.'}, paramValue.EMPTY_DOUBLE);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 274 pl.append(p);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 275
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 276 p = param({'nf', 'The number of frequency bins. Frequencies are scale logarithmically'}, paramValue.DOUBLE_VALUE(200));
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 277 pl.append(p);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 278
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 279 p = param({'diagonal only', 'Set to true if you want the PSD instead of the CPSD'}, paramValue.TRUE_FALSE);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 280 pl.append(p);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 281
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 282 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 283