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

2025-10-12 18:56:59 +02:00
commit 7e8ee264aa
553 changed files with 161447 additions and 0 deletions
--- a/Tilt/MediaDati_HD.m
+++ b/Tilt/MediaDati_HD.m
@@ -0,0 +1,125 @@
+function [ACCdef_HD,ANGdef_HD,MAGdef_HD,ARRAYdateHD,ACCdefRisHD,MAGdefRisHD] = MediaDati_HD(...
+    accHD,angHD,magHD,TimeHD,ris_acc_HD,ris_mag_HD,tolleranzaAcc,...
+    tolleranzaMag,NdatiMedia,FileName)
+
+fileID = fopen(FileName,'a');
+fmt = '%s \r';
+text = 'MediaDati_HD function started';
+fprintf(fileID,fmt,text);
+
+%% Accelerazione
+[r,~]=size(accHD);
+if NdatiMedia > r
+    NdatiMedia = r;
+end
+ACCdef_HD = smoothdata(accHD,'gaussian',NdatiMedia);
+
+% Angoli
+ANGdef_HD = smoothdata(angHD,'gaussian',NdatiMedia);
+
+%% Matrice date
+ARRAYdateHD = TimeHD;
+
+%% Risultante acc
+ACCdefRisHD = ris_acc_HD; % Non faccio la media, mi serve il dato come è per applicare i filtri  
+
+% Applico un controllo importante! Se la risultante varia più di 0.01, NON
+% faccio la media dei dati attorno, che altrimenti ne sono condizionati!
+[r,c] = size(ACCdefRisHD); % Nodi in colonna, date in riga
+Win = NdatiMedia/2; % Individuo la finestra da NON mediare
+cont = 0; % Contatore
+cont2 = 0;
+for i = 2:r % data
+    for j = 2:c % nodo
+        % se il valore assoluto della differenza è maggiore della
+        % tolleranza, NON faccio la media
+        if abs(ACCdefRisHD(i,j)-ACCdefRisHD(i-1,j)) > tolleranzaAcc || ACCdefRisHD(i,j) < 0.9 || ACCdefRisHD(i,j) > 1.1
+            Sp = i-Win; % Punto di partenza (date)
+            if Sp <= 0
+                Sp = 1;
+            end
+            if i+Win > r
+                Ep = r;
+            else
+                Ep = i+Win; % Punto di arrivo (date)
+            end
+            Cax = 3*j-2;
+            Cay = 3*j-1;
+            Caz = 3*j;
+            ACCdef_HD(Sp:Ep,Cax) = accHD(Sp:Ep,Cax); % ax
+            ACCdef_HD(Sp:Ep,Cay) = accHD(Sp:Ep,Cay); % ay
+            ACCdef_HD(Sp:Ep,Caz) = accHD(Sp:Ep,Caz); % az
+            cont = cont+1;
+        end
+    end
+end
+text = ['' num2str(cont) ' values of Tilt Link HD VR accelerometer vector of gravity not subjected to mean process due to values with excessive variations!'];
+fprintf(fileID,fmt,text);
+text = ['' num2str(cont2) ' values of Tilt Link HD VR accelerometer vector of gravity not subjected to mean process due to not calibrated values!'];
+fprintf(fileID,fmt,text);
+
+%% Campi magnetici
+MAGdef_HD = smoothdata(magHD,'gaussian',NdatiMedia);
+
+% Applico un controllo importante! Se la risultante delle accelerazioni
+% varia più di 0.01, NON faccio la media dei dati di campo magnetico attorno, 
+% che altrimenti ne sono condizionati!
+[r,c] = size(ACCdefRisHD); % Nodi in colonna, date in riga
+Win = NdatiMedia/2; % Individuo la finestra da NON mediare
+cont = 0;
+cont2 = 0;
+for i = 2:r % data
+    for j = 2:c % nodo
+        % se il valore assoluto della differenza è maggiore della
+        % tolleranza, NON faccio la media
+        if abs(ACCdefRisHD(i,j)-ACCdefRisHD(i-1,j)) > tolleranzaMag
+            Sp = i-Win; % Punto di partenza (date)
+            if Sp <= 0
+                Sp = 1;
+            end
+            if i+Win > r
+                Ep = r;
+            else
+                Ep = i+Win; % Punto di arrivo (date)
+            end
+            Cmx = 3*j-2;
+            Cmy = 3*j-1;
+            Cmz = 3*j;
+            MAGdef_HD(Sp:Ep,Cmx) = magHD(Sp:Ep,Cmx); % mx
+            MAGdef_HD(Sp:Ep,Cmy) = magHD(Sp:Ep,Cmy); % my
+            MAGdef_HD(Sp:Ep,Cmz) = magHD(Sp:Ep,Cmz); % mz
+            cont = cont+1;
+        end
+        if ACCdefRisHD(i,j) < 0.9 || ACCdefRisHD(i,j) > 1.1 % Il nodo è fuori taratura! 
+            Sp = i-Win; % Punto di partenza (date)
+            if Sp <= 0
+                Sp = 1;
+            end
+            if i+Win > r
+                Ep = r;
+            else
+                Ep = i+Win; % Punto di arrivo (date)
+            end
+            Cmx = 3*j-2;
+            Cmy = 3*j-1;
+            Cmz = 3*j;
+            MAGdef_HD(Sp:Ep,Cmx) = magHD(Sp:Ep,Cmx); % mx
+            MAGdef_HD(Sp:Ep,Cmy) = magHD(Sp:Ep,Cmy); % my
+            MAGdef_HD(Sp:Ep,Cmz) = magHD(Sp:Ep,Cmz); % mz
+            cont2 = cont2+1;
+        end
+    end
+end
+text = ['' num2str(cont) ' values of Tilt Link HD VR magnetometer vector not subjected to mean process due to accelerometers values with excessive variations!'];
+fprintf(fileID,fmt,text);
+text = ['' num2str(cont2) ' values of Tilt Link HD VR magnetometer vector of gravity not subjected to mean process due to not calibrated accelerometer values!'];
+fprintf(fileID,fmt,text);
+
+%% Risultante campi magnetici
+MAGdefRisHD = ris_mag_HD; % Non faccio la media, mi serve il dato come è per applicare i filtri
+
+text = 'Average mean of Tilt Link HD VR data executed correctly. MediaDati_HD function ended';
+fprintf(fileID,fmt,text);
+fclose(fileID);
+            
+end