pullBBpoint.m

function point = pullBBpoint(trialstruct,bbmeta,ampg,kinematicsonly)

%pullBBpoint: Get Body Builder point data from C3D file
%   Prasanna Sritharan, April 2018
% 
% -------------------------------------------------------------------- 
%     Copyright (C) 2018 Prasanna Sritharan
%     Copyright (C) 2018 La Trobe University
% 
%     This program is free software: you can redistribute it and/or modify
%     it under the terms of the GNU General Public License as published by
%     the Free Software Foundation, either version 3 of the License, or
%     (at your option) any later version.
% 
%     This program is distributed in the hope that it will be useful,
%     but WITHOUT ANY WARRANTY; without even the implied warranty of
%     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
%     GNU General Public License for more details.
% 
%     You should have received a copy of the GNU General Public License
%     along with this program.  If not, see <http://www.gnu.org/licenses/>.
% --------------------------------------------------------------------  


    % assign trial struct info
    c3dfile = trialstruct.filepath;
    vfrange = trialstruct.vfrange;
    fpseq = trialstruct.fpseq;
    triallimb = trialstruct.triallimb;


    try

        % add C3D extension if necessary
        if isempty(regexpi(c3dfile,'.c3d')), c3dfile = [c3dfile '.c3d']; end;
        
        % initiate C3DServer
        itf = c3dserver();
        
        % turn strict parameter checking off
        itf.SetStrictParameterChecking(0);

        % open C3D file
        try
            sflag = itf.Open(c3dfile,3);
        catch
            sflag = -1;
            disp('ERROR: C3D file could not be opened for processing. Please check if file exists and is not corrupted.');
        end

                
        % get number of video channels used
        idx = itf.GetParameterIndex('POINT','USED');
        nused = itf.GetParameterValue(idx,0);               
        
        % get video channel list
        vlist = cell(1,nused);
        idx = itf.GetParameterIndex('POINT','LABELS');
        for n=1:nused
            vlist{n} = itf.GetParameterValue(idx,n-1);
        end
        
        % get desired output data groups
        outgrps = bbmeta.BBGROUPS(logical(ampg));
        
        % get data for all parameters in each desired group and store in struct
        point = struct();
        for g=1:length(outgrps)
            for q=1:length(bbmeta.(outgrps{g}))
        
                % determine how to extract based on point data type
                switch outgrps{g}
                    
                    % Body Builder GRF point data
                    % merge all individual FP streams for each foot into a single channel
                    case 'GRFS'     
                        if kinematicsonly, continue; end
                        fpnums = regexp(vlist,[bbmeta.fpvectors{1} '(\d+)'],'tokens');
                        fpnums = fpnums(~cellfun('isempty',fpnums)); 
                        for f=1:2
                            qname = [bbmeta.limbs{f} bbmeta.(outgrps{g}){q}];
                            point.(outgrps{g}).(qname) = zeros(vfrange(2)-vfrange(1)+1,3);
                            for s=1:size(fpseq,1)
                                fpsuffix = fpseq(s,f);
                                if (fpsuffix==0), continue; end
                                cop = [bbmeta.fpvectors{1} num2str(fpsuffix)];
                                grf = [bbmeta.fpvectors{2} num2str(fpsuffix)];
                                copchan = find(strcmp(cop,vlist))-1;
                                grfchan = find(strcmp(grf,vlist))-1;                                
                                for x=1:3
                                    copvec = double(cell2mat(itf.GetPointDataEx(copchan,x-1,vfrange(1),vfrange(2),'1')));
                                    grfvec = double(cell2mat(itf.GetPointDataEx(grfchan,x-1,vfrange(1),vfrange(2),'1')));                                    
                                    point.(outgrps{g}).(qname)(:,x) = grfvec-copvec;
                                end
                            end
                        end
                            
                    % all other Body Builder data
                    otherwise
                        if (kinematicsonly)&&(~strcmpi(outgrps{g},'ANGLES')), continue; end
                        for f=1:2
                            qname = [bbmeta.limbs{f} bbmeta.(outgrps{g}){q}];
                            vchan = find(strcmp(qname,vlist))-1;
                            for x=1:3
                                point.(outgrps{g}).(qname)(:,x) = double(cell2mat(itf.GetPointDataEx(vchan,x-1,vfrange(1),vfrange(2),'1')));
                            end
                        end
                end
                
                
            end
        end

        % close C3D file
        itf.Close();
        
    catch excp        
        disp('ERROR: C3D file could not be processed.');
        rethrow(excp);
    end

end