generate_ts.m line 6: path_seg_len = sqrt(sqrt(sum((path(2:end, :) - path(1:end-1,:)).^2,2))); it should be: path_seg_len =sqrt(sum((path(2:end, :) - path(1:end-1,:)).^2,2));