from gridEyeReader import GridEye
|
|
from dataFuser import DataFuser
|
|
|
|
import cv2
|
|
import logging
|
|
import time
|
|
import numpy as np
|
|
|
|
logging.basicConfig(level=logging.DEBUG)
|
|
|
|
g = GridEye('/dev/ttyACM0')
|
|
d = DataFuser(10) # distance between sensors.
|
|
cv2.namedWindow("Image", cv2.WINDOW_NORMAL)
|
|
for _ in range(1000000):
|
|
frame = g.readData()
|
|
out = d.mergeFrame(np.array(frame), 100)
|
|
if type(out) is np.ndarray:
|
|
cv2.imshow('Image', cv2.cvtColor(out, cv2.COLOR_GRAY2BGR))
|
|
k = cv2.waitKey(1)
|
|
if k == ord('q'):
|
|
break
|
|
elif k == ord('c'):
|
|
cv2.imwrite('shot.png', out)
|
|
|
|
|
|
cv2.destroyAllWindows()
|
|
|