-
Notifications
You must be signed in to change notification settings - Fork 2
/
checkOneTrajectory.m
70 lines (50 loc) · 1.66 KB
/
checkOneTrajectory.m
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
pure = latLong(:,[2 3]);
[index_of_trajectory, pointer_start] = unique(latLong(:,1),'stable');
summ = 0;
zong = [];
yuzhi = 0.005;
for i = 1:length(index_of_trajectory)
if i ~= length(index_of_trajectory)
particular_trajectory = pure(pointer_start(i) : pointer_start(i+1)-1,:);
if pointer_start(i+1)- pointer_start(i) < 5
fprintf('length(%d) = %d\n', index_of_trajectory(i), pointer_start(i+1)- pointer_start(i));
end
if pointer_start(i+1)- pointer_start(i) == 1
continue;
end
else
particular_trajectory = pure(pointer_start(i) : end,:);
if size(pure,1)+1- pointer_start(i) < 5
fprintf('length(%d) = %d\n', index_of_trajectory(i), size(pure,1)+1- pointer_start(i));
end
if size(pure,1)+1- pointer_start(i) == 1
continue;
end
end
difference = diff(particular_trajectory);
zong = [zong;difference(:)];
%
pause = true;
if abs(difference(:)) < yuzhi
pause = false;
else
% disp('====================');
% [[1:size(difference,1)]',difference]
% fprintf('i = %d\n',i);
%
figure(10)
plot(particular_trajectory(:,1),particular_trajectory(:,2));
for ii = 1:size(particular_trajectory,1)
text(particular_trajectory(ii,1),particular_trajectory(ii,2),num2str(ii),'Color','r')
end
%
% a = [1:size(difference,1)]';
% a = a(:,[1 1]);
% a(abs(difference) >=yuzhi)
summ = summ +1;
end
end
figure;
histogram(abs(zong));
prctile(abs(zong),[0 98]);
summ