function [Y_PCLHR,Z_PCLHR,Ylocal_PCLHR,Zlocal_PCLHR,AlfaX_PCLHR,AlfaY_PCLHR,TempDef_PCLHR,... speed_PCLHR,speed_local_PCLHR,acceleration_PCLHR,acceleration_local_PCLHR,ARRAYdate_PCLHR,... ErrPreConvLinkHR] = elab2D_PCLHR(IDcentralina,DTcatena,rPCLHR,AngDef_PCLHR,... TempDef_PCLHR,SpePCLHR,DatiElabPreConvLinkHR,Ndevst_HR,Wdevst_HR,ARRAYdate_PCLHR,... NuovoZeroPCLHR,NdatiMedia,Ndatidespike,ErrPreConvLinkHR,margine,elab_option,Tmax,Tmin,... datainiPCLHR,FileName) %% Inizializzazione fileID = fopen(FileName,'a'); fmt = '%s \r'; text = 'elab2D_PCLHR function started'; fprintf(fileID,fmt,text); if NuovoZeroPCLHR == 1 if NdatiMedia > Ndatidespike Ndati = NdatiMedia; else Ndati = Ndatidespike; end ini = round(Ndati/2)+1; if rem(Ndati,2) == 0 ini = ini+1; end clear NDati ini = ini + margine; if ini < 6 ini = 6; end if Ndevst_HR ~= 0 % Allora prendo tutti i dati e solo in seguito considero i nuovi, a valle della funzione filtro ini = 1; end AngDef_PCLHR = AngDef_PCLHR(ini:end,:); TempDef_PCLHR = TempDef_PCLHR(ini:end,:); DatiElabPreConvLinkHR = DatiElabPreConvLinkHR(ini:end,:); ARRAYdate_PCLHR = ARRAYdate_PCLHR(ini:end,1); ErrPreConvLinkHR = ErrPreConvLinkHR(ini:end,:); end %% Definisco i dati Nnodi = rPCLHR; % Spacchetto [r,~] = size(AngDef_PCLHR); % Numero di dati [Ndati,~] = size(ARRAYdate_PCLHR); ax = zeros(r,Nnodi); ay = zeros(r,Nnodi); for i=1:Nnodi ax(:,i) = AngDef_PCLHR(:,(i-1)*2+1); % ax ay(:,i) = AngDef_PCLHR(:,(i-1)*2+2); % ay end ax = ax'; % riga nodi, colonna date ay = ay'; % riga nodi, colonna date %% Costruzione delle matrici % Dati locali asseY_PCLHR = zeros(Nnodi,Ndati); % Raccoglie i dati planari locali nella direzione di sviluppo della catena asseZ_PCLHR = zeros(Nnodi,Ndati); % Raccoglie i dati planari locali nella direzione di sviluppo della catena, basso->alto % Dati cumulati Y_PCLHR = zeros(Nnodi,Ndati); % Raccoglie i dati cumulati nella direzione di sviluppo della catena Z_PCLHR = zeros(Nnodi,Ndati); % Raccoglie i dati cumulati nella direzione di sviluppo della catena, basso->alto % Angoli AlfaX_PCLHR = zeros(Nnodi,Ndati); AlfaY_PCLHR = zeros(Nnodi,Ndati); % % parametri per il calcolo SpePCLHR = SpePCLHR(2:end,1); % valori segmenti di pertinenza % Inizio del ciclo di elaborazione text = 'Elaboration of PreConv Link HR started'; fprintf(fileID,fmt,text); ax = 0.01745329251994329576923690768489.*ax; ay = 0.01745329251994329576923690768489.*ay; for jj = 1:Ndati if jj == 1 % al primo dato raccolto riporto i punti di calcolo sui punti noti % INPUT SITO SPECIFICO DA DARE !!! fclose(fileID); if NuovoZeroPCLHR == 0 [cYo,cZo,asseY_Rif_PCLHR,asseZ_Rif_PCLHR] = punti_noti_PCLHR(... IDcentralina,DTcatena,FileName); elseif NuovoZeroPCLHR == 1 % calcolo a partire da dati già elaborati a cui mi riferisco [cYo,cZo,asseY_Rif_PCLHR,asseZ_Rif_PCLHR] = punti_noti_exe_PCLHR(... asseY_PCLHR,DatiElabPreConvLinkHR,FileName); end for ii = 1:Nnodi [Y_PCLHR,Z_PCLHR,asseY_PCLHR,asseZ_PCLHR,AlfaX_PCLHR,AlfaY_PCLHR] = ... CalcoloBiax_PCLHR(SpePCLHR,ii,jj,ax,ay,asseY_PCLHR,asseZ_PCLHR,asseY_Rif_PCLHR,... asseZ_Rif_PCLHR,Y_PCLHR,Z_PCLHR,AlfaX_PCLHR,AlfaY_PCLHR,elab_option,rPCLHR); end [shiftY_PCLHR,shiftZ_PCLHR] = pos_ini_PCLHR(cYo,cZo,Y_PCLHR,Z_PCLHR); % riporto Y e Z sui punti noti Y_PCLHR(:,jj) = Y_PCLHR(:,jj) - shiftY_PCLHR(:,1); Z_PCLHR(:,jj) = Z_PCLHR(:,jj) - shiftZ_PCLHR(:,1); else for ii = 1:Nnodi [Y_PCLHR,Z_PCLHR,asseY_PCLHR,asseZ_PCLHR,AlfaX_PCLHR,AlfaY_PCLHR] = ... CalcoloBiax_PCLHR(SpePCLHR,ii,jj,ax,ay,asseY_PCLHR,asseZ_PCLHR,asseY_Rif_PCLHR,... asseZ_Rif_PCLHR,Y_PCLHR,Z_PCLHR,AlfaX_PCLHR,AlfaY_PCLHR,elab_option,rPCLHR); end % correggo X e Z con gli offset Y_PCLHR(:,jj) = Y_PCLHR(:,jj) - shiftY_PCLHR(:,1); Z_PCLHR(:,jj) = Z_PCLHR(:,jj) - shiftZ_PCLHR(:,1); end end Yrif = Y_PCLHR; % mi serve dopo Zrif = Z_PCLHR; % mi serve dopo dY_PCLHR = diff(asseY_PCLHR,1,2); dZ_PCLHR = diff(asseZ_PCLHR,1,2); %% Controllo della Temperatura clear r clear rr clear c clear cc [r,c] = size(Z_PCLHR); fileID = fopen(FileName,'a'); fmt = '%s \r'; fprintf(fileID,fmt,text); clear i clear j cont = 1; % contatore TempDef_PCLHR = TempDef_PCLHR'; text = 'There are not correction of PreConv Link HR based on temperature filter'; FileTemperature = ['' IDcentralina '-' DTcatena '-TLHRH-Therm.csv']; if isfile(FileTemperature) == 1 DatiRaw = csvread(FileTemperature); [rDR,cDR] = size(DatiRaw); DatiRaw(:,1) = DatiRaw(:,1) + 730000; else rDR = 1; cDR = 1; end for j = 1:c % Data for i = 1:r % Nodo % NON considero i dati al di sopra di Tmax o al di sotto di Tmin if TempDef_PCLHR(i,j) > Tmax || TempDef_PCLHR(i,j) < Tmin cont = cont+1; if j == 1 if isfile(FileTemperature) == 1 RawDate = find(DatiRaw(:,1)<=datenum(datainiPCLHR)); if isempty(RawDate) == 1 cc = 2; while cc <= Ndate if TempDef_PCLHR(i,cc) > Tmax || TempDef_PCLHR(i,cc) < Tmin cc = cc+1; else break end end TempDef_PCLHR(i,j) = TempDef_PCLHR(i,cc); else if isnan(DatiRaw(RawDate(end),i+1)) == 0 TempDef_PCLHR(i,j) = DatiRaw(RawDate(end),i+1); dY_PCLHR(i,j-1) = 0; dZ_PCLHR(i,j-1) = 0; ErrPreConvLinkHR(j,i) = 0.5; wardat = 'Temperature data of PreConv Link HR nodes corrected using Raw Data of reference Csv file.'; fprintf(fileID,fmt,wardat); else cc = 2; while cc <= c if TempDef_PCLHR(i,cc) > Tmax || TempDef_PCLHR(i,cc) < Tmin cc = cc+1; else break end end TempDef_PCLHR(i,j) = TempDef_PCLHR(i,cc); end end else cc = 2; while cc <= c if TempDef_PCLHR(i,cc) > Tmax || TempDef_PCLHR(i,cc) < Tmin cc = cc+1; else break end end TempDef_PCLHR(i,j) = TempDef_PCLHR(i,cc); end else dY_PCLHR(i,j-1) = 0; dZ_PCLHR(i,j-1) = 0; TempDef_PCLHR(i,j) = TempDef_PCLHR(i,j-1); ErrPreConvLinkHR(j,i) = 0.5; end end text = ['' num2str(cont) ' correction executed for Tilt Link HR H - Temperature filter!']; end end if rDR~=1 && cDR~=1 && isempty(DatiRaw) == 0 RawDate1 = find(DatiRaw(:,1)<=ARRAYdate_PCLHR(1)); if isempty(RawDate1) == 1 RawDate2 = 1; elseif RawDate1(end) == rDR RawDate2 = find(ARRAYdate_PCLHR(:,1)>DatiRaw(end,1)); else RawDate2 = find(ARRAYdate_PCLHR(:,1)>DatiRaw(RawDate1(end)+1,1)); end else RawDate1 = []; RawDate2 = 1; end if isempty(RawDate1) == 0 && isempty(RawDate2) == 0 Dati = [DatiRaw(1:RawDate1(end),:); ARRAYdate_PCLHR(RawDate2(1):end) TempDef_PCLHR(:,RawDate2(1):end)']; elseif isempty(RawDate1) == 1 && isempty(RawDate2) == 0 Dati = [ARRAYdate_PCLHR TempDef_PCLHR']; else Dati = DatiRaw; end % Elimino appoggio più vecchio di un mese RawDate3 = find(Dati(:,1) Ndatidespike NdatiF = NdatiMedia; else NdatiF = Ndatidespike; end ini = round(NdatiF/2)+1; if rem(NdatiF,2) == 0 ini = ini+1; end clear NDatiF iniST = round(Wdevst_HR/2); if rem(Wdevst_HR,2) == 0 iniST = iniST+1; end iniST = iniST + margine; if iniST > ini ini = iniST; end if ini < 6 ini = 6; end dY_PCLHR = dY_PCLHR(:,ini:end); dZ_PCLHR = dZ_PCLHR(:,ini:end); TempDef_PCLHR = TempDef_PCLHR(ini:end,:); DatiElabPreConvLinkHR = DatiElabPreConvLinkHR(ini:end,:); ARRAYdate_PCLHR = ARRAYdate_PCLHR(ini:end,1); ErrPreConvLinkHR = ErrPreConvLinkHR(ini:end,:); end %% Finalizzo i calcoli [rx,cx] = size(dZ_PCLHR); % totale del singolo nodo data per data sommaY_PCLHR = zeros(rx,cx+1); sommaZ_PCLHR = zeros(rx,cx+1); % cumulata del singolo nodo data per data in posizione assoluta % il primo valore è quello di posizione assoluta iniziale Y_PCLHR = zeros(rx,cx+1); Z_PCLHR = zeros(rx,cx+1); % cumulata del singolo nodo data per data in posizione relativa % il primo valore è quello di posizione assoluta iniziale Ylocal_PCLHR = zeros(Nnodi,Ndati); Zlocal_PCLHR = zeros(Nnodi,Ndati); speed_PCLHR = zeros(Nnodi,Ndati); speed_local_PCLHR = zeros(Nnodi,Ndati); acceleration_PCLHR = zeros(Nnodi,Ndati); acceleration_local_PCLHR = zeros(Nnodi,Ndati); if NuovoZeroPCLHR == 1 [rE,cE] = size(DatiElabPreConvLinkHR); cont = 3; contINV = 10; n = 1; while cont<=cE if elab_option == 1 sommaY_PCLHR(n,1) = cell2mat(DatiElabPreConvLinkHR(1,cont))'; Ylocal_PCLHR(n,1) = sommaY_PCLHR(n,1); sommaZ_PCLHR(n,1) = cell2mat(DatiElabPreConvLinkHR(1,cont+1))'; Zlocal_PCLHR(n,1) = sommaZ_PCLHR(n,1); Y_PCLHR(n,1) = cell2mat(DatiElabPreConvLinkHR(1,cont+2))'; Z_PCLHR(n,1) = cell2mat(DatiElabPreConvLinkHR(1,cont+3))'; speed_local_PCLHR(n,1:rE) = cell2mat(DatiElabPreConvLinkHR(:,cont+7))'; speed_PCLHR(n,1:rE) = cell2mat(DatiElabPreConvLinkHR(:,cont+8))'; acceleration_local_PCLHR(n,1:rE) = cell2mat(DatiElabPreConvLinkHR(:,cont+9))'; acceleration_PCLHR(n,1:rE) = cell2mat(DatiElabPreConvLinkHR(:,cont+10))'; cont = cont+13; elseif elab_option == -1 sommaY_PCLHR(end-n+1,1) = cell2mat(DatiElabPreConvLinkHR(1,cE-contINV))'; Ylocal_PCLHR(end-n+1,1) = sommaY_PCLHR(end-n+1,1); sommaZ_PCLHR(end-n+1,1) = cell2mat(DatiElabPreConvLinkHR(1,cE-contINV+1))'; Zlocal_PCLHR(end-n+1,1) = sommaZ_PCLHR(end-n+1,1); Y_PCLHR(end-n+1,1) = cell2mat(DatiElabPreConvLinkHR(1,cE-contINV+2))'; Z_PCLHR(end-n+1,1) = cell2mat(DatiElabPreConvLinkHR(1,cE-contINV+3))'; speed_local_PCLHR(end-n+1,1:rE) = cell2mat(DatiElabPreConvLinkHR(:,cE-contINV+7))'; speed_PCLHR(end-n+1,1:rE) = cell2mat(DatiElabPreConvLinkHR(:,cE-contINV+8))'; acceleration_local_PCLHR(end-n+1,1:rE) = cell2mat(DatiElabPreConvLinkHR(:,cE-contINV+9))'; acceleration_PCLHR(end-n+1,1:rE) = cell2mat(DatiElabPreConvLinkHR(:,cE-contINV+10))'; contINV = contINV+13; end n = n+1; end else % Primo dato Y_PCLHR(:,1) = Yrif(:,1); Z_PCLHR(:,1) = Zrif(:,1); end for iii = 1:cx % date % somma singoli spostamenti del singolo nodo sommaY_PCLHR(:,iii+1) = sum(dY_PCLHR(:,1:iii),2)+sommaY_PCLHR(:,1); sommaZ_PCLHR(:,iii+1) = sum(dZ_PCLHR(:,1:iii),2)+sommaZ_PCLHR(:,1); % spostamenti locali riferiti allo 0 Ylocal_PCLHR(:,iii+1) = sommaY_PCLHR(:,iii+1); Zlocal_PCLHR(:,iii+1) = sommaZ_PCLHR(:,iii+1); % cumulata spostamenti if elab_option == 1 Y_PCLHR(:,iii+1) = Y_PCLHR(:,1) + cumsum(sommaY_PCLHR(:,iii+1)) - cumsum(sommaY_PCLHR(:,1)); Z_PCLHR(:,iii+1) = Z_PCLHR(:,1) + cumsum(sommaZ_PCLHR(:,iii+1)) - cumsum(sommaZ_PCLHR(:,1)); elseif elab_option == -1 Y_PCLHR = flipud(Y_PCLHR); Z_PCLHR = flipud(Z_PCLHR); Y_PCLHR(:,iii+1) = Y_PCLHR(:,1) + cumsum(flipud(sommaY_PCLHR(:,iii+1))) - cumsum(flipud(sommaY_PCLHR(:,1))); Z_PCLHR(:,iii+1) = Z_PCLHR(:,1) + cumsum(flipud(sommaZ_PCLHR(:,iii+1))) - cumsum(flipud(sommaZ_PCLHR(:,1))); Y_PCLHR = flipud(Y_PCLHR); Z_PCLHR = flipud(Z_PCLHR); end end %% Calcolo velocità di spostamento giornaliera [numDate,~] = size(ARRAYdate_PCLHR); % numero di date d = 1; p = 1; diffDate = 0; n = 1; period = 1; % calcolo giornaliero ContSUP = []; for dd = 1:numDate while diffDate < period d = d+1; if d > numDate % Se d supera le date disponibili, esco dal ciclo while break end diffDate = ARRAYdate_PCLHR(d) - ARRAYdate_PCLHR(p); end if d >numDate break end ContSUP(n,1) = d; %#ok<*AGROW> % Creo matrice indici dell'estremo superiore della differenza ContINF(n,1) = p; % Creo matrice indici dell'estremo inferiore della differenza p = p+1; % passo alla data di partenza successiva d = p; % resetto il conto di d n = n+1; diffDate = 0; end check = isempty(ContSUP); if check == 0 [nDate,~] = size(ContSUP); for s = 1:rPCLHR N = 1; for dd = 1:nDate speed_PCLHR(s,ContSUP(N,1)) = (Z_PCLHR(s,ContSUP(N,1))-Z_PCLHR(s,ContINF(N,1)))/(ARRAYdate_PCLHR(ContSUP(N,1))-ARRAYdate_PCLHR(ContINF(N,1))); speed_local_PCLHR(s,ContSUP(N,1)) = (Zlocal_PCLHR(s,ContSUP(N,1))-Zlocal_PCLHR(s,ContINF(N,1)))/(ARRAYdate_PCLHR(ContSUP(N,1))-ARRAYdate_PCLHR(ContINF(N,1))); acceleration_PCLHR(s,ContSUP(N,1)) = (speed_PCLHR(s,ContSUP(N,1))-speed_PCLHR(s,ContINF(N,1)))/(ARRAYdate_PCLHR(ContSUP(N,1))-ARRAYdate_PCLHR(ContINF(N,1))); acceleration_local_PCLHR(s,ContSUP(N,1)) = (speed_local_PCLHR(s,ContSUP(N,1))-speed_local_PCLHR(s,ContINF(N,1)))/(ARRAYdate_PCLHR(ContSUP(N,1))-ARRAYdate_PCLHR(ContINF(N,1))); N = N+1; end end end fclose(fileID); % Approssimo i dati con il corretto numero di cifre decimali [Y_PCLHR,Z_PCLHR,Ylocal_PCLHR,Zlocal_PCLHR,TempDef_PCLHR,speed_PCLHR,... speed_local_PCLHR,acceleration_PCLHR,acceleration_local_PCLHR,AlfaX_PCLHR,AlfaY_PCLHR] = ... approx_PCL(Y_PCLHR,Z_PCLHR,Ylocal_PCLHR,Zlocal_PCLHR,TempDef_PCLHR,speed_PCLHR,speed_local_PCLHR,... acceleration_PCLHR,acceleration_local_PCLHR,AlfaX_PCLHR,AlfaY_PCLHR,FileName); % Riordino matrice errori [r,~] = size(ErrPreConvLinkHR); Matrice_err = zeros(r,rPCLHR); for i = 1:r % date d = 1; for n = 1:rPCLHR % nodi j = 1; err = ErrPreConvLinkHR(i,d:d+2); while j <= 3 if err(1,j) == 1 Matrice_err(i,n) = 1; end j = j+1; end d = d+3; end end ErrPreConvLinkHR = Matrice_err'; text = 'PreConv Link HR calculation executed correctly'; fileID = fopen(FileName,'a'); fmt = '%s \r'; fprintf(fileID,fmt,text); fclose(fileID); end