-
Notifications
You must be signed in to change notification settings - Fork 2
/
TrackFunc.py
82 lines (60 loc) · 3.37 KB
/
TrackFunc.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
67
68
69
70
71
72
73
74
75
76
77
78
79
############################################################
################### TRACKING ALGORITHMS ####################
############################################################
import cv2
lk_params = dict(winSize=(10, 10),
maxLevel=2,
criteria=(cv2.TERM_CRITERIA_EPS | cv2.TERM_CRITERIA_COUNT, 10, 0.03))
def Track(frame1,frame2,cap,point_selected):
while cap.isOpened():
diff = cv2.absdiff(frame1, frame2)
gray = cv2.cvtColor(diff, cv2.COLOR_BGR2GRAY)
blur = cv2.GaussianBlur(gray, (3, 3), 0)
_, thresh = cv2.threshold(blur, 20, 255, cv2.THRESH_BINARY)
dilated = cv2.dilate(thresh, None, iterations=5)
contours, _ = cv2.findContours(dilated, cv2.RETR_TREE, cv2.CHAIN_APPROX_SIMPLE)
gray_frame = cv2.cvtColor(frame2, cv2.COLOR_BGR2GRAY)
for contour in contours:
i =1
(x, y, w, h) = cv2.boundingRect(contour)
if cv2.contourArea(contour) > 4000:
continue
if point_selected is True:
new_points, status, error = cv2.calcOpticalFlowPyrLK(old_gray, gray_frame, old_points, None, **lk_params)
old_gray = gray_frame.copy()
old_points = new_points
# print(new_points)
x_, y_ = new_points.ravel()
if (abs(x-x_) <= 25) & (abs(y-y_ <=25)) :
p1 = x_
p2 = y_
cv2.circle(frame1, ((int)(x_), (int)(y_)), 5, (0, 255, 0), -1)
cv2.rectangle(frame1, (x, y), (x + w, y + h), (0, 255, 0), 2)
cv2.putText(frame1, "tracking", (x, y - 10), cv2.FONT_HERSHEY_SIMPLEX, 0.5, (40,235, 249), 2)
x_y_coor = "track X: " + str(x_) + ", strack Y: " + '_' + str(y_)
cv2.putText(frame1, x_y_coor, (100,150), cv2.FONT_HERSHEY_SIMPLEX, 0.9, (40, 235, 249), 2)
center = "image center: " + str(frame1.shape[1]//2) +" , "+ str(frame1.shape[0]//2)
cv2.putText(frame1, center, (100,100), cv2.FONT_HERSHEY_SIMPLEX, 0.9, (40, 235, 249), 2)
#
# center_ = "move X: " + str((frame1.shape[1]//2) - x_) + ", move Y: " + str((frame1.shape[0]//2)-x_)
# cv2.putText(frame1, center_, (100, 200), cv2.FONT_HERSHEY_SIMPLEX, 0.9, (40, 235, 249), 2)
center2_ = "move X: " + str(round(x_)) + ", move Y: " + str(
round(y_))
cv2.putText(frame1, center2_, (100, 200), cv2.FONT_HERSHEY_SIMPLEX, 0.9, (40, 235, 249), 2)
else :
old_gray = gray_frame.copy()
old_points = new_points
# print(new_points)
x_, y_ = new_points.ravel()
p1 = x_
p2 = y_
cv2.circle(frame1, ((int)(x_), (int)(y_)), 5, (50, 50, 100), -1)
else :
cv2.rectangle(frame1, (x, y), (x + w, y + h), (0, 0, 255), 2)
cv2.putText(frame1, 'Movement Found!', (x, y - 10), cv2.FONT_HERSHEY_SIMPLEX, 0.5, (0, 0, 255), 2)
cv2.drawContours(frame1, contours, -1, (0,255,0), 2)
#frame_resized = rescale_frame(frame1, scale=0.5)
cv2.imshow("Frame", frame1)
frame1 = frame2
ret, frame2 = cap.read()
# point_selected = False