Sync from remote server: 2025-10-12 18:56:41

Tilt/defDatiTL.m

@@ -0,0 +1,157 @@
+% Funzione che definisce accelerazioni (accTL), dati magnetici (magTL), 
+% temperature (tempTL) per i nodi di tipo Tilt Link
+
+function [TimeTL,accTL,magTL,tempTL,ErrTiltLink] = defDatiTL(DatiTiltLink,...
+    ErrTiltLink,Ndatidespike,rTL,MEMS,conn,catena,IDcentralina,DTcatena,Unit,FileName)
+
+fileID = fopen(FileName,'a');
+fmt = '%s \r';
+text = 'defDatiTL function started';
+fprintf(fileID,fmt,text);
+
+[r,c] = size(DatiTiltLink);
+Ncorr = 0;
+% Elimino gli eventuali Not a Number
+for a = 2:r
+    for b = 1:c
+        check = isnan(DatiTiltLink(a,b));
+        if check == 1
+            DatiTiltLink(a,b) = DatiTiltLink(a-1,b);
+            ErrTiltLink(a,b-1) = 1;
+            Ncorr = Ncorr+1;
+        end
+    end
+end
+
+text = [num2str(Ncorr) ' NaN of Tilt Link V corrected by defDatiTL function'];
+fprintf(fileID,fmt,text);
+
+% Definisco Data (gg:mm:aaaa hh:mm), Batteria, i 3 dati di accelerometro
+% e magnetometro e la Temperatura per la calibrazione
+TimeTL = DatiTiltLink(:,1); % data
+accTL = zeros(r,rTL*3); % dati accelerometro
+magTL = zeros(r,rTL*3); % dati magnetometro
+tempTL = zeros(r,rTL); % temperatura del nodo per la calibrazione
+p = 7; % passo nella definizione dei dati
+
+% NOTA: Si esegue l'inversione delle colonne N°9 e N°8 per considerare 
+% l'errore in lettura sulle centraline, ovvero lo scambio degli assi 
+% y e z del magnetometro.
+s = 1;
+m = 1;
+
+if MEMS == 1 % inverto le colonne Y e Z del magnetometro (MEMS vecchi, PRE 21 Maggio 2016)
+    for i = 1:rTL
+        accTL(:,s) = DatiTiltLink(:,2+(i-1)*p);
+        accTL(:,s+1) = DatiTiltLink(:,3+(i-1)*p);
+        accTL(:,s+2) = DatiTiltLink(:,4+(i-1)*p);    
+        s = s+3;
+        magTL(:,m) = DatiTiltLink(:,5+(i-1)*p);
+        magTL(:,m+1) = DatiTiltLink(:,7+(i-1)*p);
+        magTL(:,m+2) = DatiTiltLink(:,6+(i-1)*p);
+        m = m+3;
+        tempTL(:,i) = DatiTiltLink(:,8+(i-1)*p);
+    end
+elseif MEMS == 2 % Nodi nuovi, dopo 21 Maggio 2016
+    for i = 1:rTL
+        accTL(:,s) = DatiTiltLink(:,2+(i-1)*p);
+        accTL(:,s+1) = DatiTiltLink(:,3+(i-1)*p);
+        accTL(:,s+2) = DatiTiltLink(:,4+(i-1)*p);    
+        s = s+3;
+        magTL(:,m) = DatiTiltLink(:,5+(i-1)*p);
+        magTL(:,m+1) = DatiTiltLink(:,6+(i-1)*p);
+        magTL(:,m+2) = DatiTiltLink(:,7+(i-1)*p);
+        m = m+3;
+        tempTL(:,i) = DatiTiltLink(:,8+(i-1)*p);
+        [rT,~] = size(tempTL);
+        for j = 1:rT
+            if tempTL(j,i) > 200
+               tempTL(j,i) = tempTL(j,i) - 256; % Correzione della temperatura dei nuovi MEMS
+            end
+        end
+    end
+elseif MEMS == 3 % Nodi nuovi, dopo 21 Maggio 2016
+    for i = 1:rTL
+        accTL(:,s) = DatiTiltLink(:,2+(i-1)*p);
+        accTL(:,s+1) = DatiTiltLink(:,3+(i-1)*p);
+        accTL(:,s+2) = DatiTiltLink(:,4+(i-1)*p);    
+        s = s+3;
+        magTL(:,m) = DatiTiltLink(:,5+(i-1)*p);
+        magTL(:,m+1) = DatiTiltLink(:,6+(i-1)*p);
+        magTL(:,m+2) = DatiTiltLink(:,7+(i-1)*p);
+        m = m+3;
+        tempTL(:,i) = DatiTiltLink(:,8+(i-1)*p);
+    end
+end
+
+if strcmp(Unit,'G301') == 1
+    i = 1;
+    j = 1;
+    while i <= 3*rTL
+        for ii = 2:r
+            if accTL(ii,i) == -8191 && accTL(ii,i+1) == 0 && accTL(ii,i+2) == 0
+                accTL(ii,i) = accTL(ii-1,i);
+                accTL(ii,i+1) = accTL(ii-1,i+1);
+                accTL(ii,i+2) = accTL(ii-1,i+2);
+                magTL(ii,i) = magTL(ii-1,i);
+                magTL(ii,i+1) = magTL(ii-1,i+1);
+                magTL(ii,i+2) = magTL(ii-1,i+2);
+                tempTL(ii,j) = tempTL(ii-1,j);
+                ErrTiltLink(ii,i) = 1;
+            end
+        end
+        i = i+3;
+        j = j+1;
+    end
+end
+
+s = 1;
+m = 1;
+Num_Dati = Ndatidespike; % numero di dati per il despike
+if Num_Dati > r
+    Num_Dati = r;
+end
+for i = 1:rTL
+    % despiking accelerometri
+    accTL(:,s) = filloutliers(accTL(:,s),'linear','movmedian',Num_Dati);    
+    accTL(:,s+1) = filloutliers(accTL(:,s+1),'linear','movmedian',Num_Dati);    
+    accTL(:,s+2) = filloutliers(accTL(:,s+2),'linear','movmedian',Num_Dati);    
+    s = s+3;
+    % despiking magnetometri
+    magTL(:,m) = filloutliers(magTL(:,m),'linear','movmedian',Num_Dati);    
+    magTL(:,m+1) = filloutliers(magTL(:,m+1),'linear','movmedian',Num_Dati);    
+    magTL(:,m+2) = filloutliers(magTL(:,m+2),'linear','movmedian',Num_Dati);  
+    m = m+3;
+end
+
+%% Specifico DT0002
+if strcmp(DTcatena,'DT0002')
+    TL = 1;
+    TRec = zeros(rTL,1);
+    [rC,~] = size(catena);
+    idNodo = cell2mat(catena(:,1));
+    for a = 1:rC
+        nNodo = mat2str(cell2mat(catena(a,3)));
+        if idNodo(a,1) == 1 % Tilt Link V
+            %% Importazione dei dati di calibrazione per Tilt Link V
+            comando = ['select Cal9 from CalibrationView where UnitName = '''...
+                IDcentralina ''' and ToolNameID = ''' DTcatena ''' and NodeNum = ''' nNodo ''''];
+            curs = exec(conn,comando);
+            curs = fetch(curs);
+            TRec(TL,:) = cell2mat(curs.Data); % matrice che raccoglie i dati del nodo numero 'a' di tipo Tilt Link V
+            TL = TL+1;
+            ok = ['Temperature calibration coefficient of node Tilt Link V number ' nNodo ' chain DT0002 recovered correctly'];
+            fprintf(fileID,fmt,ok);
+        end
+    end
+    for ii=1:rTL
+        tempTL(:,ii) = tempTL(:,ii)/128+TRec(ii);
+    end
+    accTL = accTL/16;
+end
+
+text = 'Data of Tilt Link V defined correctly. defDatiTL function ended';
+fprintf(fileID,fmt,text);
+fclose(fileID);
+
+end