125 lines
4.6 KiB
Matlab
Executable File
125 lines
4.6 KiB
Matlab
Executable File
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 |