-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathfind_cross_xy.m
184 lines (138 loc) · 4.45 KB
/
find_cross_xy.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
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
function [x,y] = find_cross_xy(I,ROI)
% FIND_CROSS_XY returns the estimated coordinate of the hand drawn
% cross
%
% Syntax:
% [x,y] = find_cross_xy(I,ROI)
%
% Inputs:
% I - Image I
% ROI - Rectange Region of Interest (where the cross is likely to be)
%
% Outputs:
% x,y coords of the cross
I=createMask_black(I);
I=imcrop(I,ROI);
BW=~I;
% figure,imshow(BW);
BW=imclearborder(BW); % entfernen der Randobjekte
% imshow(BW);
%% Linien detektieren
[H,T,R] = hough(BW);
P = houghpeaks(H,10,'threshold',ceil(0.3*max(H(:))));
x = T(P(:,2)); y = R(P(:,1));
% plot(x,y,'s','color','white');
lines = houghlines(BW,T,R,P,'FillGap',1,'MinLength',1);
% figure, imshow(I), hold on
max_len = 0;
function []= plotlines()
for k = 1:length(lines)
xy = [lines(k).point1; lines(k).point2];
plot(xy(:,1),xy(:,2),'LineWidth',2,'Color','green');
% Plot beginnings and ends of lines
plot(xy(1,1),xy(1,2),'x','LineWidth',2,'Color','yellow');
plot(xy(2,1),xy(2,2),'x','LineWidth',2,'Color','red');
% Determine the endpoints of the longest line segment
len = norm(lines(k).point1 - lines(k).point2);
if ( len > max_len)
max_len = len;
end
end
end
%calculate the cross coords
upper_limit=100000;
lower_limit=0;
x_min=upper_limit;% large pixelcount
y_min=upper_limit;
x_max=lower_limit;% small
y_max=lower_limit;
x_sum=0;
y_sum=0;
%% Bestimmen des average Punkts um ROI mithilfe eines Radius zu bestimmen
for k= 1:length(lines)
x_sum=x_sum+lines(k).point1(1)+lines(k).point2(1);
y_sum=y_sum+lines(k).point1(2)+lines(k).point2(2);
end
x_avg=x_sum/(2*length(lines));
y_avg=y_sum/(2*length(lines));
radius=300;
errorNo=0;
%% Bestimme den Mittelpunkt des Kreuzes. hier anhand der Mitte der Extremwerte
% avg der Werte auch denkbar.(war teilweise weniger robust)
function[]= calculateIntersection()
errorNo=errorNo+1;
for k= 1:length(lines)
%% eingrenzen des ROI fuer Linien
if (abs(lines(k).point1(1)-x_avg)<radius && abs(lines(k).point1(2)-y_avg)<radius)
%% betrachte Horizontale Linien
if (abs(lines(k).theta)>80)
if(lines(k).point1(2)<y_min)
y_min=lines(k).point1(2);
end
if(lines(k).point1(2)>y_max)
y_max=lines(k).point1(2);
end
else
%% Betrachte Vertikale
if(abs(lines(k).theta)<10)
if(lines(k).point1(1)<x_min)
x_min=lines(k).point1(1);
end
if(lines(k).point1(1)>x_max)
x_max=lines(k).point1(1);
end
end
end
end
end
if(x_max==lower_limit || x_min==upper_limit)
% error('ERROR: Kreuz nicht im ROI oder zu klein / ungenau')
figure; imshow(I);
if(errorNo==2)
title('ErrorLvl 2: Zoome in das Kreuz! und drücke Enter');
zoom on;
waitfor(gcf, 'CurrentCharacter', char(13))
zoom reset
zoom off
title('wähle das Kreuz aus mit linker Maustaste!');
[x,y] = ginput(1)
else
title('ERROR Lvl1 :X Koord Kreuz nicht im ROI wähle Kreuz wähle ROI (Grob) manuell');
[x_avg,y_avg]=ginput(1);
calculateIntersection();
end
end
if(y_max==lower_limit || y_min==upper_limit)
% error('ERROR: Kreuz nicht im ROI oder zu klein / ungenau')
figure; imshow(I);
if(errorNo==2)
title('ErrorLvl 2: Zoome in das Kreuz! und drücke Enter');
zoom on;
waitfor(gcf, 'CurrentCharacter', char(13))
zoom reset
zoom off
title('wähle das Kreuz aus mit linker Maustaste!');
[x,y] = ginput(1)
else
title('ERROR Lvl1 :Y Koord Kreuz nicht im ROI wähle Kreuz wähle ROI (Grob) manuell');
[x_avg,y_avg]=ginput(1);
calculateIntersection();
end
end
%% Wenn Fehler auftritt soll manuell ein ROI ausgewählt werden können.
if(errorNo<2)
y=(y_max+y_min)/2;
x=(x_max+x_min)/2;
end
end
calculateIntersection();
plot(x,y,'x','LineWidth',4,'Color','yellow');
close gcf
%% Berechne die Koordinaten im gesamten (urspruenglichen) Bild
x=ROI(1)+x;
y=ROI(2)+y;
% Swap x und y. Grund nicht ganz klar. funktioniert so.
% c=x;
% x=y;
% y=c;
end