Найти порядковое значение экстремума трехмерной замкнутой траектории по осям x y z (три одномерных массива)

   clear all
close all
clc
 
[fname, pname] = uigetfile('*.txt', 'Select txt data base files', 'MultiSelect', 'on');
 
if ~isequal(fname, 0)
  if ~iscell(fname)
    fname = {fname};
  end
  fname = sort(fname);
  
  figure; hold on
  
  for k=1:length(fname)
    fullname = fullfile(pname, fname{k});
    
    m=fileread(fullname);
    m(m==',')='.';
  
    k=textscan(m,' %f%f%f');
    M=cell2mat(k);
 
    Xem = M(:, 1);
    Yem = M(:, 2);
    Zem = M(:, 3);
 
    Xm = Xem (1:length(Xem)); 
    Ym = Yem (1:length(Yem)); 
    Zm = Zem (1:length(Zem)); 
 
    % Фильтруем данные
 
    Xa = smooth(Xm,20);
    Ya = smooth(Ym,20);
    Za = smooth(Zm,20);
    
    
    X1=cumtrapz(Xa-mean(Xa));
 
 
    X2=cumtrapz(X1-mean(X1));  
    % Второе интегрирование по оси х
 
    Y1=cumtrapz(Ya-mean(Ya)); 
    % Превое интегрирование по оси у
 
    Y2=cumtrapz(Y1-mean(Y1)); 
    % Второе интегрирование по оси у
 
    Z1=cumtrapz(Za-mean(Za)); 
    % Превое интегрирование по оси z
 
    Z2=cumtrapz(Z1-mean(Z1));
 
%находим экстремумы
 
X2p = findpeaks(X2);
X2pp = findpeaks(-X2);
Y2p = findpeaks(Y2);
Y2pp = findpeaks(-Y2); 
Z2p = findpeaks(Z2);
Z2pp = findpeaks(-Z2);
 
    plot3(X2,Y2,Z2);
 
  end
end