0
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 1 % CPSDFORINDEPENDENTINPUTS 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: cpsdForIndependentInputs computes the output theoretical
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 5 % CPSD or PSD shape for given input shapes.
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 6 % It returns summed and individual contributions and takes
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 7 % input vectors of objects (instead of square matrices)
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 8 %
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 9 % CALL: [mat_outSum, mat_out] = PSD(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_outSum - contains specified returned aos, noise is
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 16 % summed over all the specified input noises
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 17 % mat_out - contains specified returned aos
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 18 %
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 19 % <a href="matlab:utils.helper.displayMethodInfo('ssm', 'cpsdForIndependentInputs')">Parameters Description</a>
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 20 %
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 21 % VERSION: $Id: cpsdForIndependentInputs.m,v 1.2 2011/05/23 14:18:20 adrien Exp $
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 22 %
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 23 %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 24
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 25 function varargout = cpsdForIndependentInputs(varargin)
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 26
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 27 %% starting initial checks
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 28
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 29 % use the caller is method flag
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 30 callerIsMethod = utils.helper.callerIsMethod;
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 31
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 32 % Check if this is a call for parameters
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 33 if utils.helper.isinfocall(varargin{:})
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 34 varargout{1} = getInfo(varargin{3});
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 35 return
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 36 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 37
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 38 utils.helper.msg(utils.const.msg.MNAME, ['running ', mfilename]);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 39
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 40 % Collect input variable names
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 41 in_names = cell(size(varargin));
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 42 for ii = 1:nargin,in_names{ii} = inputname(ii);end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 43
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 44 % Collect all SSMs and plists
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 45 [sys, ssm_invars, rest] = utils.helper.collect_objects(varargin(:), 'ssm', in_names);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 46 [pl, invars2, rest] = utils.helper.collect_objects(rest(:), 'plist');
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 47 if ~isempty(rest)
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 48 pl = combine(pl, plist(rest{:}));
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 49 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 50 pl = combine(pl, getDefaultPlist());
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 51
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 52 %%% Internal call: Only one object + don't look for a plist
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 53 internal = strcmp(varargin{end}, 'internal');
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 54
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 55 %% begin function body
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 56
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 57 %% retrieve system infos
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 58
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 59 if numel(sys)~=1
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 60 error('noisespectrum needs exactly one ssm as an input')
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 61 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 62 if ~sys.isnumerical
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 63 error(['error because system ',sys.name,' is not numerical']);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 64 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 65 if ~sys.isStable
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 66 error('input ssm is not stable!')
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 67 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 68 if sys.timestep==0
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 69 timestep = 1;
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 70 else
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 71 timestep = sys.timestep;
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 72 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 73 if ~internal
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 74 inhist = sys.hist;
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 75 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 76
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 77 %% modifying system's ordering
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 78 if find(pl, 'reorganize')
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 79 sys = reorganize(sys, pl, 'set', 'for cpsdForIndependentInputs', 'internal', 'internal');
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 80 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 81
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 82 %% collecting functions i/o data
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 83 aos_in = find(pl, 'aos');
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 84 PZ_in = find(pl, 'PZmodels');
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 85 cov_in = find(pl, 'variance');
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 86 cpsd_in = find(pl, 'PSD');
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 87
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 88 noise_mat = [...
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 89 reshape(cov_in, [numel(cov_in),1]) ; ...
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 90 reshape(cpsd_in, [numel(cpsd_in),1]) / (timestep*2)];
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 91 if sum(noise_mat<0) > 0
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 92 error('input PSD is not positive!')
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 93 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 94
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 95 %% getting system's i/o sizes
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 96 inputSizes = sys.inputsizes;
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 97 outputSizes = sys.outputsizes; %#ok<NASGU>
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 98
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 99 Naos_in = inputSizes(1);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 100 Nnoise = inputSizes(2);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 101 NPZmodels = inputSizes(3);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 102
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 103 %% retrieving frequency vector
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 104 if isempty(Naos_in)==0
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 105 f1 = find(pl,'f1');
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 106 f2 = find(pl,'f2');
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 107 NFreqs = find(pl,'nf');
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 108 if isempty(f1) || isempty(f2)|| isempty(NFreqs)
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 109 error('### Please specify frequency vector a start and stop frequency .');
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 110 else
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 111 freqs = 10 .^ linspace(log10(f1), log10(f2), NFreqs);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 112 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 113 else
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 114 freqs = aos_in(1).x;
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 115 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 116
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 117 %% checking frequency vector
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 118 for i=2:numel(aos_in)
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 119 if ~isequal(freqs,aos_in(i).x)
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 120 error('there exist different frequency vectors');
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 121 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 122 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 123
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 124 %% reshape pzmodels and aos for input cross-spectra
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 125 if numel(PZ_in)==NPZmodels
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 126 PZdata = zeros(NPZmodels,NFreqs);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 127 for i=1:NPZmodels
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 128 a = resp(PZ_in(i), freqs);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 129 PZdata(i,:) = reshape(a.y,[1,NFreqs]) ;
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 numel(aos_in)==Naos_in
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 136 AOdata = zeros(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 AOdata(i,:) = reshape(aos_in(i).y,[1,NFreqs]) ;
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 139 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 140 else
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 141 error('Wrong size for field aos_in')
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 142 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 143
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 144 %% SSM Transfer function
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 145 [a, b, c, d, Ts, InputName, StateName, OutputName,...
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 146 inputvarunits, ssvarunits, outputvarunits] = double(sys); %#ok<ASGLU>
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 147 resps = ssm.doBode(a, b, c, d, 2*pi*freqs, Ts);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 148 Noutputs = numel(OutputName);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 149
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 150 %% power for each frequency with SVD computation
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 151 diagOnly = pl.find('DIAGONAL ONLY');
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 152 if diagOnly
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 153 Result = zeros(Noutputs, Nnoise+Naos_in+NPZmodels, NFreqs);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 154 else
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 155 Result = zeros(Noutputs, Noutputs, Nnoise+Naos_in+NPZmodels, NFreqs);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 156 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 157
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 158 for ff=1:NFreqs
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 159 for ii = 1:(Nnoise+Naos_in+NPZmodels)
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 160 powWhiteNoise = zeros(1,Nnoise);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 161 powAO = zeros(1, Naos_in);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 162 powPZ = zeros(1,NPZmodels);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 163 if ii<Nnoise+1,
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 164 %% contribution from white noise
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 165 powWhiteNoise(ii) = noise_mat(ii) ;
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 166 elseif ii<Nnoise+Naos_in+1
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 167 %% contribution from aos
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 168 i_input2 = ii-Nnoise;
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 169 if AOdata(i_input2,ff)<0
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 170 error('input PSD is not positive!')
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 171 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 172 powAO(i_input2) = AOdata(i_input2,ff);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 173 else
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 174 %% contribution from PZmodels
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 175 i_input2 = ii-Nnoise-Naos_in;
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 176 if PZdata(i_input2,ff)<0
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 177 error('input PSD is not positive!')
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 178 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 179 powPZ(i_input2) = real( PZdata(i_input2,ff) * conj( PZdata(i_input2,ff)) );
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 180 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 181 %% computing CPSD
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 182 pow = diag([powAO; powWhiteNoise; powPZ]);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 183 RespLoc = squeeze(resps(:,:,ff));
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 184 noise = RespLoc * pow * RespLoc' * (2*timestep);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 185 if diagOnly
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 186 Result(:,ii,ff) = real(diag(noise));
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 187 else
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 188 Result(:,:,ii,ff) = noise;
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 189 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 190
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 191 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 192 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 193
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 194 %% saving in aos
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 195 if diagOnly
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 196 ao_outSum = ao.initObjectWithSize(Noutputs, 1);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 197 %% sum of all inputs
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 198 for oo=1:Noutputs
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 199 ao_outSum(oo,1).setData(fsdata(freqs, squeeze(sum(Result(oo,:,:),2)) ));
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 200 ao_outSum(oo,1).setName( ['PSD of ' , OutputName{oo} ' due to all contributions']);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 201 ao_outSum(oo,1).setXunits('Hz');
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 202 ao_outSum(oo,1).setYunits(outputvarunits(oo)^2/unit('Hz'));
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 203 ao_outSum(oo,1).setDescription( ['PSD of ' , OutputName{oo} ' due to all contributions']);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 204 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 205 if nargout ~= 1;
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 206 ao_out = ao.initObjectWithSize(Noutputs, Nnoise+Naos_in+NPZmodels);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 207 %% individual inputs
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 208 for oo=1:Noutputs
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 209 for ii=1:(Nnoise+Naos_in+NPZmodels)
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 210 ao_out(oo,ii).setData(fsdata(freqs, squeeze(Result(oo,ii,:)) ));
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 211 ao_out(oo,ii).setName( ['PSD of ' , OutputName{oo} ' due to ' InputName{ii}]);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 212 ao_out(oo,ii).setXunits('Hz');
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 213 ao_out(oo,ii).setYunits(outputvarunits(oo)^2/unit('Hz'));
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 214 ao_out(oo,ii).setDescription( ['PSD of ' , OutputName{oo} ' due to ' InputName{ii}]);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 215 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 216 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 217 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 218 else
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 219 ao_outSum = ao.initObjectWithSize(Noutputs, Noutputs);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 220 %% sum of all inputs
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 221 for oo=1:Noutputs
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 222 for pp=1:Noutputs
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 223 ao_outSum(oo,pp).setData(fsdata(freqs, squeeze(sum(Result(oo,pp,:,:),3)) ));
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 224 ao_outSum(oo,pp).setXunits('Hz');
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 225 ao_outSum(oo,pp).setYunits(outputvarunits(oo)^2/unit('Hz'));
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 226 if oo~=pp
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 227 ao_outSum(oo,pp).setName( ['Cross PSD of ', OutputName{oo}, ' and ', OutputName{pp} ' due to all contributions']);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 228 ao_outSum(oo,pp).setDescription( ['Cross PSD of ', OutputName{oo}, ' and ', OutputName{pp} ' due to all contributions']);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 229 else
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 230 ao_outSum(oo,pp).setName( ['PSD of ' , OutputName{oo}]);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 231 ao_outSum(oo,pp).setDescription( ['PSD of ' , OutputName{oo}]);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 232 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 233 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 234 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 235 if nargout ~= 1;
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 236 ao_out = ao.initObjectWithSize(Noutputs, Noutputs, Nnoise+Naos_in+NPZmodels);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 237 %% individual inputs
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 238 for oo=1:Noutputs
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 239 for pp=1:Noutputs
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 240 for ii=1:(Nnoise+Naos_in+NPZmodels)
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 241 ao_out(oo,pp,ii).setData(fsdata(freqs, squeeze(Result(oo,pp,ii,:)) ));
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 242 ao_out(oo,pp,ii).setXunits('Hz');
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 243 ao_out(oo,pp,ii).setYunits(outputvarunits(oo)^2/unit('Hz'));
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 244 if oo~=pp
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 245 ao_out(oo,pp,ii).setName( ['Cross PSD of ', OutputName{oo}, ' and ', OutputName{pp} ' due to ' InputName{ii}]);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 246 ao_out(oo,pp,ii).setDescription( ['Cross PSD of ', OutputName{oo}, ' and ', OutputName{pp} ' due to ' InputName{ii}]);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 247 else
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 248 ao_out(oo,pp,ii).setName( ['PSD of ' , OutputName{oo} ' due to ' InputName{ii}]);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 249 ao_out(oo,pp,ii).setDescription( ['PSD of ' , OutputName{oo} ' due to ' InputName{ii}]);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 250 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 251 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 252 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 253 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 254 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 255 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 256
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 257
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 258
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 259 %% construct output matrix object
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 260 if nargout ~= 1;
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 261 out = matrix(ao_out);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 262 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 263 outSum = matrix(ao_outSum);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 264 if callerIsMethod
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 265 % do nothing
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 266 else
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 267 myinfo = getInfo('None');
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 268 if nargout ~= 1;
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 269 out.addHistory(myinfo, pl , ssm_invars(1), inhist );
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 270 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 271 outSum.addHistory(myinfo, pl , ssm_invars(1), inhist );
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 272 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 273
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 274 %% Set output depending on nargout
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 275 if nargout == 1;
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 276 varargout = {outSum};
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 277 elseif nargout == 2;
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 278 varargout = {outSum out };
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 279 elseif nargout == 0;
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 280 iplot(ao_outSum, ao_out);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 281 else
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 282 error('Wrong number of outputs')
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 283 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 284 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 285
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 286
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 287
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 288
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 289 %--------------------------------------------------------------------------
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 290 % Get Info Object
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 291 %--------------------------------------------------------------------------
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 292 function ii = getInfo(varargin)
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 293
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 294 if nargin == 1 && strcmpi(varargin{1}, 'None')
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 295 sets = {};
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 296 pl = [];
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 297 else
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 298 sets = {'Default'};
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 299 pl = getDefaultPlist;
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 300 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 301 % Build info object
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 302 ii = minfo(mfilename, 'ssm', 'ltpda', utils.const.categories.op, '$Id: cpsdForIndependentInputs.m,v 1.2 2011/05/23 14:18:20 adrien Exp $', sets, pl);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 303
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 304 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 305
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 306 %--------------------------------------------------------------------------
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 307 % Get Default Plist
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 308 %--------------------------------------------------------------------------
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 309 function pl = getDefaultPlist()
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 310 pl = ssm.getInfo('reorganize', 'for cpsdForIndependentInputs').plists;
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 311 pl.remove('set');
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 312
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 313 p = param({'variance', 'The variance vector of this noise between input ports for the <i>time-discrete</i> noise model. '}, []);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 314 pl.append(p);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 315
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 316 p = param({'PSD', 'The one sided psd vector of the white noise between input ports.'}, []);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 317 pl.append(p);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 318
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 319 p = param({'aos', 'A vector of input PSD AOs, The spectrum of this noise between input ports for the <i>time-continuous</i> noise model.'}, ao.initObjectWithSize(1,0));
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 320 pl.append(p);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 321
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 322 p = param({'PZmodels', 'vector of noise shape filters for the different corresponding inputs.'}, paramValue.DOUBLE_VALUE(zeros(0,1)));
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 323 pl.append(p);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 324
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 325 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
+ − 326 pl.append(p);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 327
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 328 p = param({'f2', 'The maximum frequency. Default is Nyquist or 1Hz.'}, paramValue.EMPTY_DOUBLE);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 329 pl.append(p);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 330
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 331 p = param({'f1', 'The minimum frequency. Default is f2*1e-5.'}, paramValue.EMPTY_DOUBLE);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 332 pl.append(p);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 333
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 334 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
+ − 335 pl.append(p);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 336
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 337 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
+ − 338 pl.append(p);
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 339
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 340 end
Daniele Nicolodi <nicolodi@science.unitn.it>
parents:
diff
changeset
+ − 341