source: proiecte/pmake3d/make3d_original/Make3dSingleImageStanford_version0.1/third_party/BlueCCal/MultiCamSelfCal/FindingPoints/im2points.m @ 37

% Read all images and extract point coordinates.
%
% All information needed are stored and retrieved 
% from the function CONFIGDATA

% $Author: svoboda $
% $Revision: 2.6 $
% $Id: im2points.m,v 2.6 2005/05/23 16:26:03 svoboda Exp $
% $State: Exp $

clear all;

% add path to config data
addpath ../../CommonCfgAndIO
% add path for graphical output if needed
addpath ../OutputFunctions

SHOWFIG   = 0; % show images during point extraction
STEP4STAT = 1; % step for computing average and std images, if 1 then all images taken

config = configdata(expname);

im.dir = config.paths.img;
im.ext = config.files.imgext;

NoCams = size(config.files.idxcams,2);  % number of cameras 

% load image names
for i=1:NoCams,
  seq(i).camId = config.files.idxcams(i);
  if seq(i).camId > -1
        if findstr(expname,'oscar')
          seq(i).data = dir([sprintf(im.dir,seq(i).camId),config.files.imnames,'*.',im.ext]);
        else
          seq(i).data = dir([sprintf(im.dir,seq(i).camId),sprintf(config.files.imnames,seq(i).camId),im.ext]);
        end
  else
        seq(i).data = dir([im.dir,sprintf(config.files.imnames),im.ext]);
  end
  seq(i).size = size(seq(i).data,1);
  if seq(i).size<4
        error('Not enough images found. Wrong image path or name pattern?');
  end
end


% create an occupancy matrix for image frames
occmat=1; try config.files.maxid; catch occmat=0; end
if occmat,
        NoPoints = config.files.maxid;
        FrameMat = zeros(config.files.maxid,NoCams);
        for i=1:NoCams,
                seq(i).imgidx = zeros(size(1:NoPoints));
                for j=1:size(seq(i).data,1)
                        FrameMat(str2num(seq(i).data(j).name(config.files.posid)),i)=j;
                end
        end
else
        NoPoints = min([seq.size]);
        FrameMat = zeros(NoPoints,NoCams);
        for i=1:NoCams,
                FrameMat(:,i) = [1:NoPoints]';
        end
end

% In fact, some frames might be without any calibration point

% Becouse of non-consistent stopping of capturing, the sequences might 
% have different number of images, select the minimal value as the right one

%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
%%% beginning of the findings

t = cputime;
for i=1:NoCams,
  if ~exist(sprintf(config.files.avIM,seq(i).camId)),
        disp(sprintf('The average image of the camera %d is being computed',seq(i).camId));
        avIM = zeros(size(imread([sprintf(im.dir,seq(i).camId),seq(i).data(1).name])));
        pointIdx = 1:STEP4STAT:seq(i).size;
        for j=pointIdx,
          IM = imread([sprintf(im.dir,seq(i).camId),seq(i).data(j).name]);
          avIM = avIM + double(IM);
        end
        avIM = uint8(round(avIM./size(pointIdx,2)));
        imwrite(avIM,sprintf(config.files.avIM,seq(i).camId));
  else  disp('Average file already exists');
  end
end
disp(sprintf('Elapsed time for computation of average images: %4.2f [sec]',cputime-t))
% compute the standard deviations images that will be used for finding LEDs
% if not already computed
t = cputime;
for i=1:NoCams,
  if ~exist(sprintf(config.files.stdIM,seq(i).camId)),
        avIM = double(imread(sprintf(config.files.avIM,seq(i).camId)));
        disp(sprintf('The image of standard deviations of the camera %d is being computed',seq(i).camId));
        stdIM = zeros(size(imread([sprintf(im.dir,seq(i).camId),seq(i).data(1).name])));
        pointIdx = 1:STEP4STAT:seq(i).size;
        for j=pointIdx,
          IM = imread([sprintf(im.dir,seq(i).camId),seq(i).data(j).name]);
          stdIM = stdIM + (double(IM)-avIM).^2;
        end
        stdIM = uint8(round(sqrt(stdIM./(size(pointIdx,2)-1))));
        imwrite(stdIM,sprintf(config.files.stdIM,seq(i).camId));
  else
        disp('Image of standard deviations already exists')
  end
end

disp(sprintf('Elapsed time for computation of variance images: %4.2f [sec]',cputime-t))

% find points in the images
Ws    = [];       % joint image matrix
Res       = [];   % resolution of cameras
% UsableFramesIdx = find(sum(FrameMat')>2);
IdMat = ones(NoCams,NoPoints);
% IdMat is very important for Martinec&Pajdla filling [ECCV2002]
% it is a NoCams x NoPoints matrix, 
% IdMat(i,j) = 0 -> no j-th point in i-th
% IdMat(i,j) = 1 -> point successfully detected


disp('*********************************************')
disp('Finding points (laser projections) in cameras')
disp(sprintf('Totally %d cameras, %d images for each cam', NoCams, NoPoints'))
disp('*********************************************')
for i=1:NoCams,
  t1 = cputime;
  disp(sprintf('Finding points in camera No: %0.2d',config.files.idxcams(i)))
  Points = [];
  avIM  = imread(sprintf(config.files.avIM,seq(i).camId));
  stdIM = imread(sprintf(config.files.stdIM,seq(i).camId));
  for j=1:NoPoints,
          fprintf(1,'\b\b\b\b\b\b %5d',j);
          idx2data = FrameMat(j,i);
          if idx2data
                  [pos,err] = getpoint([sprintf(im.dir,seq(i).camId),seq(i).data(idx2data).name], SHOWFIG, config.imgs, avIM, stdIM);
          else
                  err = 1;
          end
        if err    
          IdMat(i,j) = 0;
          Points = [Points, [NaN; NaN; NaN]];
        else
          Points = [Points, [pos; 1]];
        end
  end
  Ws = [Ws; Points];
  Res= [Res; size(avIM,2), size(avIM,1)];
  t2 = cputime;
  disp(sprintf('\nElapsed time for finding points in one camera: %d minutes %d seconds',floor((t2-t1)/60), round(mod((t2-t1),60))))
  disp(sprintf('%4d points found in camera No: %0.2d',sum(Points(3,:)>0),config.files.idxcams(i)));
end

%%% End of the findings
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%

if findstr(expname,'oscar')
  % needs special care for handling projector data
  ProjPoints = load(config.files.projdata,'-ASCII');
  Ws = [Ws; ProjPoints(:,end-1:end)'; ones(size(ProjPoints(:,1)'))];
  IdMat = [IdMat; ones(size(ProjPoints(:,1)'))];
  Res   = [Res; config.imgs.projres];
end

save(config.files.points, 'Ws','-ASCII')
save(config.files.Res, 'Res', '-ASCII')
save(config.files.IdMat, 'IdMat', '-ASCII')

% display the overall statistics 
disp('Overall statistics from im2points:  ************************  ')
disp(sprintf('Total number of frames (possible 3D points): %d',NoPoints))
disp(sprintf('Total number of cameras %d', NoCams))
disp('More important statistics: *********************************  ')
disp(sprintf('Detected 3D points:                    %d', sum(sum(IdMat)>0)))
disp(sprintf('Detected 3D points in at least 3 cams: %d', sum(sum(IdMat)>2)))
disp(sprintf('Detected 3D points in ALL cameras:     %d', sum(sum(IdMat)==NoCams)))