center_of_mass_matrix=center_of_mass_frame(mass_matrix,cartesian_matrix)

function center_of_mass_matrix=center_of_mass_frame(mass_matrix,cartesian_matrix)

N=length(mass_matrix);

for i=1:length(cartesian_matrix(:,1))/N
    
    center_of_mass=sum(diag(mass_matrix)*cartesian_matrix(N*(i-1)+1:N*i,:),1)/sum(mass_matrix);

    center_of_mass_matrix(1:N,1:3,i)=cartesian_matrix(N*(i-1)+1:N*i,:)-ones(N,3)*diag(center_of_mass);

end