function [ CM_cabeca] = CM( datc3d )
%UNTITLED7 Summary of this function goes here
%   Detailed explanation goes here

%% Opções de carregar o arquivo

%openc3d
marcadores = loadc3d(datc3d);

marcmat = array2matrix(marcadores);

frame = 100;
cabeca_dist = marcmat(frame,3*1-2 : 3*1);
ombro_dir = marcmat(frame,3*3-2 : 3*3);
ombro_esq = marcmat(frame,3*7-2 : 3*7);
cabeca_proximal = (ombro_dir + ombro_esq) / 2;

CM_cabeca = cabeca_proximal + 0.55 * (cabeca_dist - cabeca_proximal);

close all
plot3(cabeca_dist(:,1) , cabeca_dist(:,2) , cabeca_dist(:,3), '*') % grafico da cabeça distal
hold on
plot3(cabeca_proximal(:,1) , cabeca_proximal(:,2) , cabeca_proximal(:,3), 'o') % grafico da cabeça proximal
plot3(CM_cabeca(:,1) , CM_cabeca(:,2) , CM_cabeca(:,3), '+') % grafico do CM da cabeça
box on
grid on
daspect([1 1 1])
xlabel('x')
ylabel('y')
zlabel('z')
end