Eaiser way to calculate 3D paths

If you have a as your time series acceleration data, then just do:

>>v = cumtrapz(a);
>>p = cumtrapz(p);

This works because velocity is the integral of acceleration and position is the integral of velocity. Now you have v = velocity series and p = position series.