source: trunk/src/series/beam_forming.m @ 1033

Last change on this file since 1033 was 1033, checked in by sommeria, 3 years ago

miscellaneous updates

File size: 13.5 KB
Line 
1%=======================================================================
2% Copyright 2008-2018, LEGI UMR 5519 / CNRS UGA G-INP, Grenoble, France
3%   http://www.legi.grenoble-inp.fr
4%   Joel.Sommeria - Joel.Sommeria (A) legi.cnrs.fr
5%
6%     This file is part of the toolbox UVMAT.
7%
8%     UVMAT is free software; you can redistribute it and/or modify
9%     it under the terms of the GNU General Public License as published
10%     by the Free Software Foundation; either version 2 of the license,
11%     or (at your option) any later version.
12%
13%     UVMAT is distributed in the hope that it will be useful,
14%     but WITHOUT ANY WARRANTY; without even the implied warranty of
15%     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
16%     GNU General Public License (see LICENSE.txt) for more details.
17%=======================================================================
18
19function ParamOut=beam_forming(Param)
20
21%% set the input elements needed on the GUI series when the function is selected in the menu ActionName or InputTable refreshed
22if isstruct(Param) && isequal(Param.Action.RUN,0)
23    ParamOut.AllowInputSort='off';% allow alphabetic sorting of the list of input file SubDir (options 'off'/'on', 'off' by default)
24    ParamOut.WholeIndexRange='on';% prescribes the file index ranges from min to max (options 'off'/'on', 'off' by default)
25    ParamOut.NbSlice='off'; %nbre of slices ('off' by default)
26    ParamOut.VelType='off';% menu for selecting the velocity type (options 'off'/'one'/'two',  'off' by default)
27    ParamOut.FieldName='off';% menu for selecting the field (s) in the input file(options 'off'/'one'/'two', 'off' by default)
28    ParamOut.FieldTransform = 'off';%can use a transform function
29    %ParamOut.TransformPath=fullfile(fileparts(which('uvmat')),'transform_field');% path to transform functions (needed for compilation only)
30    ParamOut.ProjObject='off';%can use projection object(option 'off'/'on',
31    ParamOut.Mask='off';%can use mask option   (option 'off'/'on', 'off' by default)
32    index=msgbox_uvmat('INPUT_TXT','index of the series to process (1 to 5)');%choose the i index of the dat files
33    ParamOut.OutputDirExt=['.p_formed_' index];%set the output dir extension
34    hseries=findobj(allchild(0),'Tag','series');
35    hhseries=guidata(hseries);
36    set(hhseries.num_last_i,'String',index)
37    set(hhseries.num_first_i,'String',index)
38    ParamOut.OutputFileMode='NbInput';% '=NbInput': 1 output file per input file index, '=NbInput_i': 1 file per input file index i, '=NbSlice': 1 file per slice
39      %check the input files
40    first_j=[];
41    if isfield(Param.IndexRange,'first_j'); first_j=Param.IndexRange.first_j; end
42    PairString='';
43    if isfield(Param.IndexRange,'PairString'); PairString=Param.IndexRange.PairString; end
44    [i1,i2,j1,j2] = get_file_index(Param.IndexRange.first_i,first_j,PairString);
45    FirstFileName=fullfile_uvmat(Param.InputTable{1,1},Param.InputTable{1,2},Param.InputTable{1,3},...
46        Param.InputTable{1,5},Param.InputTable{1,4},i1,i2,j1,j2);
47    if ~exist(FirstFileName,'file')
48        msgbox_uvmat('WARNING',['the first input file ' FirstFileName ' does not exist'])
49    end
50    return
51end
52
53ParamOut=[]; %default output
54%% read input parameters from an xml file if input is a file name (batch mode)
55checkrun=1;
56if ischar(Param)
57    Param=xml2struct(Param);% read Param as input file (batch case)
58    checkrun=0;
59end
60hseries=findobj(allchild(0),'Tag','series');
61RUNHandle=findobj(hseries,'Tag','RUN');%handle of RUN button in GUI series
62WaitbarHandle=findobj(hseries,'Tag','Waitbar');%handle of waitbar in GUI series
63
64%% define the directory for result file (with path=RootPath{1})
65OutputDir=[Param.OutputSubDir Param.OutputDirExt];% subdirectory for output files
66if ~isfield(Param,'InputFields')
67    Param.InputFields.FieldName='';
68end
69
70%% root input file type
71RootPath=Param.InputTable{1,1};
72RootFile=Param.InputTable{1,3};
73SubDir=Param.InputTable{1,2};
74NomType=Param.InputTable{1,4};
75FileExt=Param.InputTable{1,5};
76[filecell,i1_series,i2_series,j1_series,j2_series]=get_file_series(Param);
77%%%%%%%%%%%%
78% The cell array filecell is the list of input file names, while
79% filecell{iview,fileindex}:
80%        iview: line in the table corresponding to a given file series
81%        fileindex: file index within  the file series,
82% i1_series(iview,ref_j,ref_i)... are the corresponding arrays of indices i1,i2,j1,j2, depending on the input line iview and the two reference indices ref_i,ref_j
83% i1_series(iview,fileindex) expresses the same indices as a 1D array in file indices
84%%%%%%%%%%%%
85% NbSlice=1;%default
86% if isfield(Param.IndexRange,'NbSlice')&&~isempty(Param.IndexRange.NbSlice)
87%     NbSlice=Param.IndexRange.NbSlice;
88% end
89NbView=numel(i1_series);%number of input file series (lines in InputTable)
90NbField_j=size(i1_series{1},1); %nb of fields for the j index (bursts or volume slices)
91NbField_i=size(i1_series{1},2); %nb of fields for the i index
92NbField=NbField_j*NbField_i; %total number of fields
93
94%% determine the file type on each line from the first input file
95NcTypeOptions={'netcdf','civx','civdata'};
96for iview=1:NbView
97    if ~exist(filecell{iview,1}','file')
98        disp_uvmat('ERROR',['the first input file ' filecell{iview,1} ' does not exist'],checkrun)
99        return
100    end
101    [FileInfo{iview},MovieObject{iview}]=get_file_info(filecell{iview,1});
102    FileType{iview}=FileInfo{iview}.FileType;
103   CheckImage{iview}=strcmp(FileInfo{iview}.FieldType,'image');% =1 for images
104    CheckNc{iview}=~isempty(find(strcmp(FileType{iview},NcTypeOptions)));% =1 for netcdf files
105    if ~isempty(j1_series{iview})
106        frame_index{iview}=j1_series{iview};
107    else
108        frame_index{iview}=i1_series{iview};
109    end
110end
111
112% clear all
113% close all
114% read_data=1;
115affichage=0;
116% soustraction=0;
117
118%%%%%% Prepare output
119load (fullfile(RootPath,SubDir,[RootFile '.mat']))
120Data.ListGlobalAttribute={'CoordUnit'}; %%TODO: add also time, how to get it  ?????
121Data.CoordUnit='pixel';
122Data.ListVarName={'Coord_x','Coord_y','A'};
123Data.VarDimName={'Coord_x','Coord_y',{'Coord_y','Coord_x'}};
124%Data.Coord_x=5*(nbvoie_reception-0.5)/numel(nbvoie_reception); % totql length of e
125Data.Coord_x=1:65;
126%Data.Coord_z=(1:A)/133 ;% to check from input parameter ....
127Data.Coord_y=1:332;
128%%%%%%
129%
130% while test_fin_fichier>0
131%     if read_data==1
132%directory='manip_lgit';%%%%%%%%%%%%%%%%%
133%name='test';%%%%%%%%%%%%%%%%%
134%         number=2;
135number=str2num(Param.OutputDirExt(11:end));%extract the subsequence index (from 1 to 5)
136numero_tir_fin_old=1%%%%%%% =0 ?????
137pas_fichier=20;%  %20;% nbre of successive shots to read (to account for computer memory limit)
138Nmoy=800;  %%%%% value 20  FOR TEST : to shift to VALUE 8000 set by the .mat file
139
140test_fin_fichier=1;% test to stop input file reading
141while test_fin_fichier>0
142    numero_tir_debut=1;
143    numero_tir_fin=numero_tir_fin_old+pas_fichier-1;
144   
145    %  eval(['load ' directory '\' name '.mat'])
146    matrice_finale=zeros(A,length(nbvoie_reception),numero_tir_fin);%A=nbre of times (coord z)=2650, numero_tir_fin=time index
147    time=(b/rsf+[0:A-1]/rsf); %b=250, rsf=10,
148    freq1=0.5;freq2=1.5;
149    [BB AA]=butter(4,[freq1 freq2]/rsf*2);
150
151    for ii=1:length(nbvoie_reception)%=64
152        %eval(['fid=fopen(''E:\ManipLGITLecoeur\' directory '\' name '_' num2str(number) '_' num2str(nbvoie_reception(ii)) '.dat'',''r'');']);
153        filename=fullfile_uvmat(RootPath,SubDir,RootFile,FileExt,NomType,number,[],ii); % input file name
154        fid=fopen(filename);
155        toto=zeros(Nsequence*A*numero_tir_fin+31,1);% Nsequence=1
156        toto=fread(fid,numero_tir_fin*A*Nsequence+31,'int16','ieee-le') ;% why shift by 31 ?????
157        toto=double(bitxor(uint16(toto),uint16(2048)));
158        toto(1:31)=[];toto(numero_tir_fin*A*Nsequence)=mean(toto);
159        fclose(fid);
160       
161        tata=reshape(toto-2048,A,numero_tir_fin);
162        matrice_finale(:,ii,:)=reshape(tata,[A,1,numero_tir_fin]);
163        clear toto tata
164    end
165   
166   % matrice_finale(:,:,numero_tir_debut:numero_tir_fin_old)=[];%%%%%%% first field removed (when numero_tir_fin_old=1) ?????
167     matrice_finale(:,:,numero_tir_debut:numero_tir_fin_old-1)=[];%%%%%%%
168  %  numero_tir_fin=numero_tir_fin-1;  ?????
169    matrice_finale=reshape(filtfilt(BB,AA,matrice_finale(:,:)),size(matrice_finale));% low pass filtered input signal,along first (time) index?
170   
171    % if soustraction==1
172    %     eval(['load moyenne_' name '_' num2str(number) '.mat matrice_finale_moy'])
173    %     for kk=1:size(matrice_finale,3)
174    %         matrice_finale(:,:,kk)=matrice_finale(:,:,kk)-matrice_finale_moy;
175    %     end
176    % end
177    %eval(['save matrice_finale_' num2str(numero_tir_fin_old) '_' num2str(numero_tir_fin) '.mat'])
178   
179    %%%%%%%%%%%%%%Imagerie
180    fe=rsf*1e6;% sampling frequency for receptor (in Hz)
181    cc=1475;%speed of sound
182    hanning_window=25;
183    hanning_vect=hanning(2*hanning_window+1);
184    interval=[1:size(matrice_finale,1)];
185    freq=0:fe/length(interval):fe*(1-1/length(interval));
186   
187    pas_reseau_z=0.75e-3;%0.75e-3
188    pas_reseau_r=0;
189    voie_mean=length(nbvoie_reception)/2;%32;
190    reseau_z=[0:length(nbvoie_reception)-1]*pas_reseau_z;
191    reseau_z=reseau_z-reseau_z(voie_mean);
192    reseau_r=[0:length(nbvoie_reception)-1]*pas_reseau_r;
193    reseau_r=reseau_r-reseau_r(voie_mean);
194   
195    debut_r=(time(1)+20)*1e-6*cc/2;
196    fin_r=(time(end)-20)*1e-6*cc/2;
197   
198    image_r=debut_r:.5e-3:fin_r;
199    image_z=-24e-3:.75e-3:24e-3;
200   
201    image_fin=zeros(length(image_r),length(image_z),size(matrice_finale,3));%size=(332,65,pas_fichier)
202    %image_fin_bis=zeros(length(image_r),length(image_z),size(matrice_finale,3));
203    %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
204   
205    %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
206    for kk=1:size(matrice_finale,3)
207        disp(kk)
208        signal=squeeze(matrice_finale(interval,:,kk));
209        tata_fft=fft(signal,[],1);%FFT of the time signal size=(2650,64)     
210        if kk==1           
211            matrice_freq_mean=mean(abs(fft(signal,[],1)),2);
212            X=[freq1*1e6 freq2*1e6];
213            [I J]=find(freq>=X(1) & freq<=X(2));
214            int_freq=find(matrice_freq_mean(round(1:length(freq)/2))>max(matrice_freq_mean(round(1:length(freq)/2)))/2);
215            bandwidth=freq(int_freq(end)-int_freq(1));
216            %clear matrice_freq_mean
217        end
218       
219        for ii=1:length(image_r)
220            for jj=1:length(image_z)
221               
222                delay=zeros(length(nbvoie_reception),1);
223                delay=1/cc*sqrt((reseau_z-image_z(jj)).^2+(reseau_r-image_r(ii)).^2);
224               
225                [ind centre_z]=min(abs((reseau_z-image_z(jj))));
226                interval_utile=round(((delay(centre_z)+1/cc*abs(image_r(ii)))*fe)-(b+interval(1)-1)+round(length(motifbase)/2)+[-fe/bandwidth/2:fe/bandwidth/2]);
227                delay=delay-delay(centre_z);
228               
229                hanning_vecteur=zeros(1,length(nbvoie_reception));
230                if centre_z>hanning_window & centre_z<(length(nbvoie_reception)-hanning_window)
231                    hanning_vecteur(centre_z+[-hanning_window:hanning_window])=hanning_vect;
232                elseif centre_z<=hanning_window
233                    test=hanning_vect((centre_z+[-hanning_window:hanning_window])>=1);
234                    hanning_vecteur(1:length(test))=test;
235                elseif centre_z>=(length(nbvoie_reception)-hanning_window)
236                    test=hanning_vect((centre_z+[-hanning_window:hanning_window])<=length(nbvoie_reception));
237                    hanning_vecteur(length(nbvoie_reception)+[-length(test)+1:0])=test;
238                end
239                hanning_vecteur=hanning_vecteur/norm(hanning_vecteur);
240                clear test;
241               
242                amplitude_weight=ones(size(signal,1),1)*hanning_vecteur;
243                signal_new_rec=zeros(size(signal,1),length(nbvoie_reception));
244               
245                tata=zeros(size(signal,1),size(signal,2));
246                tata(J,:)=tata_fft(J,:).*exp(1i*2*pi*(freq(J)'*delay));
247                signal_new_rec=2*real(ifft(tata,[],1)).*amplitude_weight;
248                index_interval_utile=find(interval_utile>0 & interval_utile<size(signal,1));
249                toto=zeros(length(index_interval_utile),1);
250                toto=mean(signal_new_rec(interval_utile(index_interval_utile),:),2);
251                image_fin(ii,jj,kk)=sqrt(mean(toto.^2));
252                clear signal_bis interval_utile index_interval_utile hanning_vecteur
253            end
254        end
255    end
256   
257    clear signal_new_em signal_new_rec m delay toto toto_bis tata tata_fft
258   
259    if affichage==1
260        for kk=1:size(image_fin,3)
261           
262            figure(1)
263            imagesc(image_r*1e2,image_z*1e2,image_fin(:,:,kk)'/max(max(image_fin(:,:,kk)))');
264            title(['avec beamforming - energie max = ' num2str(max(max(image_fin(:,:,kk))))])
265            colorbar;
266            xlabel('r (cm)');ylabel('z (cm)');
267            drawnow
268            pause(.2);
269        end
270    end
271   
272    clear matrice_finale
273   
274    %%%%%%% TO ADAPT
275    for iii=1:size(image_fin,3)
276        Data.A=image_fin(:,:,iii);% time lapse decreasesas z coordinate increases.
277        FileIndex=numero_tir_fin - pas_fichier+iii;%%%%%%TO CHECK!!!!!
278        %%%%%%%%%%
279        %eval(['save analyse_' name '_' num2str(number) '_' num2str(numero_tir_fin_old) '_' num2str(numero_tir_fin) '.mat'])
280        OutputFile=fullfile_uvmat(RootPath,OutputDir,'signal','.nc','_00001',FileIndex);
281        error=struct2nc(OutputFile,Data);%save result file
282        if isempty(error)
283            disp(['output file ' OutputFile ' written'])
284        else
285            disp(error)
286        end
287    end
288    numero_tir_fin_old=numero_tir_fin+1% first index for next bloc reading
289     if (numero_tir_fin_old+pas_fichier-1)>Nmoy
290    test_fin_fichier=-1;
291    end
292end
293
294
Note: See TracBrowser for help on using the repository browser.