-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathproc_helper.py
66 lines (58 loc) · 1.99 KB
/
proc_helper.py
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
import cv2
import numpy as np
import math
def detectTargets(capture):
#Bir kare al
# Gürültü kaldırma için gerekli kerneller
kernel = np.ones((9,9),np.uint8)
kernel2 = np.ones((13,13),np.uint8)
# Beyazlık filtresi
gray = cv2.cvtColor(capture, cv2.COLOR_BGR2GRAY)
_, filter1 = cv2.threshold(gray,240,255,cv2.THRESH_BINARY)
# Arkaplandaki beyaz noktaları ve cisim üzerindeki siyah noktaları yok et
filter2 = cv2.morphologyEx(filter1, cv2.MORPH_OPEN, kernel)
filter3 = cv2.morphologyEx(filter2, cv2.MORPH_CLOSE, kernel2)
#Kontur bul
_, contours, _ = cv2.findContours(filter3,cv2.RETR_TREE,cv2.CHAIN_APPROX_SIMPLE)
return contours
def rectangle(img, contours):
try:
cnt1 = contours[0]
except IndexError:
return img
#Targetları dikdörtgen içine al
rect1 = cv2.minAreaRect(cnt1)
box_p1 = cv2.boxPoints(rect1)
box1 = np.int0(box_p1)
cv2.drawContours(img,[box1],0,(0,0,255),2)
return img
def cntTest(cnt):
rect = cv2.minAreaRect(cnt)
width = min(rect[1][0], rect[1][1])
height = max(rect[1][0], rect[1][1])
ratio = width/height
if cv2.contourArea(cnt) > 200 and ratio > 0.35 and ratio < 1.2:
return True
else:
return False
def calculateErrors(contours):
try:
cnt1 = contours[0]
except IndexError:
return False, 0
#Target etrafında dikdörtgensel bölge oluştur
rect1 = cv2.minAreaRect(cnt1)
boxP1 = cv2.boxPoints(rect1)
box1 = np.int0(boxP1)
#Targetların ağırlık merkezini bul
M1 = cv2.moments(box1)
center1x = int(M1['m10']/M1['m00'])
center1y = int(M1["m01"] / M1["m00"])
#Targetların ekran merkezine olan uzaklığı arasındaki fark -> Y eksenindeki hata
cameraHeight = 40
targetHeight = 300
cameraAngle = 10
targetAngle = (180 - center1y) / 180 * 43.30
distance = (targetHeight-cameraHeight)/ math.tan(cameraAngle+targetAngle)
yError = 320 - center1x
return True, yError, distance