ImageProcessing-With-OpenCV-For-Hyperloop-Project/OpenCVprojectForHyperloop.py at main · necmettinalver/ImageProcessing-With-OpenCV-For-Hyperloop-Project · GitHub

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
import cv2
import time
import datetime

yol_liste = [600, 1000, 1400, 1800, 2200, 2600, 3000, 3400, 3800, 4200, 4600,
             5000, 5400, 5800, 6200, 6600, 7000, 7400, 7800, 7805, 7810, 7815,
             7820, 7825, 7830, 7835, 7840, 7845, 7850, 7855, 7860, 7865, 7870,
             7875, 7880, 7885, 7890, 7895, 7900, 7905, 7910, 7915, 7920, 7925,
             7930, 7935, 7940, 7945, 7950, 7955, 7960, 7965, 7970, 7975, 7980,
             7985, 7990, 7995, 8200, 8600, 9000, 9400, 9800, 10200, 10600,
             11000, 11400, 11800, 12200, 12600, 13000, 13005, 13010, 13015,
             13020, 13025, 13030, 13035, 13040, 13045, 13050, 13055, 13060,
             13065, 13070, 13075, 13080, 13085, 13090, 13095, 13400, 13800,
             14200, 14600, 15000, 15400, 15800, 16200, 16600, 17000, 17400]

cap = cv2.VideoCapture(0)
yellowReflectorCounter=0
redReflectorCounter=0
reflectorCount=0

firstTime = datetime.datetime.now()
startTime = datetime.datetime.now()
nowTime = datetime.datetime.now()

def cycle():

    cap.set(cv2.CAP_PROP_FRAME_WIDTH, 1280)
    cap.set(cv2.CAP_PROP_FRAME_HEIGHT, 720)

    while True:

        global redReflectorCounter
        global reflectorCount
        global yellowReflectorCounter

        global firstTime
        global startTime
        global nowTime

        delayTime= delay(reflectorCount)
        print("delay time",delayTime)
        time.sleep(delayTime)

        if(reflectorCount==0):
            firstTime = datetime.datetime.now()

        _, frame = cap.read()
        frame = cv2.flip(frame, 1)
        hsv_frame = cv2.cvtColor(frame, cv2.COLOR_BGR2HSV)
        height, width, _ = frame.shape

        cx = int(width / 2)
        cy = int(height / 2)

        # Pick pixel value
        pixel_center = hsv_frame[cy, cx]
        hue_value = pixel_center[0]

        color = "Undefined"
        if 1< hue_value < 6:
            color = "RED"
            redReflectorCounter=redReflectorCounter+1
            reflectorCount=reflectorCount+1
            startTime=nowTime
            nowTime = datetime.datetime.now()


        elif 10 <= hue_value < 33:
            color = "SARI"
            yellowReflectorCounter=yellowReflectorCounter + 1
            reflectorCount=reflectorCount+1
            startTime=nowTime
            nowTime = datetime.datetime.now()


        elif 131 <= hue_value < 180:
            color = "RED"
            redReflectorCounter=redReflectorCounter+1
            reflectorCount=reflectorCount+1
            startTime=nowTime
            nowTime = datetime.datetime.now()

        else:
            color = "Siyah"
            isReflekUp=False


        pixel_center_bgr = frame[cy, cx]
        b, g, r = int(pixel_center_bgr[0]), int(pixel_center_bgr[1]), int(pixel_center_bgr[2])

        cv2.rectangle(frame, (cx - 220, 10), (cx + 200, 120), (255, 255, 255), -1) #yazının arkasına beyaz font
        cv2.putText(frame, color, (cx - 200, 100), 0, 3, (b, g, r), 5) #aynı renk olsun diye bgrla yazı yazdırma
        cv2.putText(frame, str(hue_value), (cx - 200, 200), 0, 3, (255, 255,255), 5)

        cv2.putText(frame, "KSayac:"+str(redReflectorCounter), (cx - 200, 300), 0, 3, (255, 255, 255), 5)
        cv2.putText(frame, "SSayac:"+str(yellowReflectorCounter), (cx - 200, 400), 0, 3, (255, 255, 255), 5)

        cv2.circle(frame, (cx, cy), 5, (25, 25, 25), 3) #orta noktaya yuvarlak koydum belli olsun diye


        cv2.imshow("Frame", frame)
        key = cv2.waitKey(1)
        if key == 27:
            break
    return reflectorCount
    cap.release()
    cv2.destroyAllWindows()


def delay(reflectorCount):
    if reflectorCount==0:
        return 1 ##hata devam ederse ilk burayı

    global yol_liste
    global firstTime
    global startTime
    global nowTime

    check()

    print("")
    print("")
    accelerationSeconds=(nowTime - startTime).seconds
    onsetSeconds=(nowTime - firstTime).seconds
    print("Starting code time: ",firstTime)
    print("Start Time: ", startTime)
    print("Now Time: ", nowTime)
    print("Between reflektor Seconds:" , onsetSeconds)

    if(reflectorCount==1):
        mesafe=(yol_liste[reflectorCount-1])/100
    elif(reflectorCount>1):
        mesafe=((yol_liste[reflectorCount-1])/100)-((yol_liste[reflectorCount-2])/100)
    #print("Mesafe: ",mesafe)
    print("Location(m): ",yol_liste[reflectorCount-1]/100)

    acceleration=mesafe/accelerationSeconds
    hız=((yol_liste[reflectorCount-1])/100)/onsetSeconds
    print("İvme: ", acceleration)
    print("Speed: ", hız)
    print("Reflektör sayısı: ",reflectorCount)
    ##burda sayılar matematiksel olarak hesaplanıp değiştirilecek
    if(hız<10):
        return 1
    elif (hız<20):
        return 1
    elif (hız<30):
        return 1
    elif (hız<40):
        return 1

def check():
    global reflectorCount
    global yellowReflectorCounter

    if (yellowReflectorCounter==1):
        reflectorCount=20

    if yellowReflectorCounter==40:
        reflectorCount=60

def home():
    global startTime
    startTime = datetime.datetime.now()
    reflectorCount = cycle()

#created by Necmettin Alver
home()