import cv2
import sys
import xlwt
import imutils

book = xlwt.Workbook(encoding="utf-8")
sheet1 = book.add_sheet("Sheet 1") 
major_ver, minor_ver, subminor_ver= 3, 4, 1
i=0
j=0
k=0
t=0
tdata=[]
xdata=[]
ydata=[]


if __name__ == '__main__' :
 
    # Set up tracker.
    # Instead of MIL, you can also use
 
    tracker_types = ['BOOSTING', 'MIL','KCF', 'TLD', 'MEDIANFLOW', 'GOTURN']
    tracker_type = tracker_types[1]
 
    if int(minor_ver) < 3:
        tracker = cv2.Tracker_create(tracker_type)
    else:
        if tracker_type == 'BOOSTING':
            tracker = cv2.TrackerBoosting_create()
        if tracker_type == 'MIL':
            tracker = cv2.TrackerMIL_create()
        if tracker_type == 'KCF':
            tracker = cv2.TrackerKCF_create()
        if tracker_type == 'TLD':
            tracker = cv2.TrackerTLD_create()
        if tracker_type == 'MEDIANFLOW':
            tracker = cv2.TrackerMedianFlow_create()
        if tracker_type == 'GOTURN':
            tracker = cv2.TrackerGOTURN_create()
 
    # Read video
    video = cv2.VideoCapture("drop.mp4")
    
    
    # Exit if video not opened.
    if not video.isOpened():
        print ("Could not open video")
        sys.exit()
 
    # Read first frame.
    ok, frame = video.read()

    if not ok:
        print ('Cannot read video file')
        sys.exit()
     
    # Define an initial bounding box
    #bbox = (287, 23, 86, 320)
 
    # Uncomment the line below to select a different bounding box
    bbox = cv2.selectROI(frame, False)
    
    xdata.append((bbox[0]+bbox[2])/2)
    ydata.append((bbox[1]+bbox[3])/2)
    tdata.append(t)
    # Initialize tracker with first frame and bounding box
    ok = tracker.init(frame, bbox)
 
    while True:
        # Read a new frame
        ok, frame = video.read()
     
        if not ok:
            break
         
        # Start timer
        timer = cv2.getTickCount()
 
        # Update tracker
        ok, bbox = tracker.update(frame)
 
        # Calculate Frames per second (FPS)
        fps = cv2.getTickFrequency() / (cv2.getTickCount() - timer);
        t=t+1/fps
        tdata.append(t)
        # Draw bounding box
        if ok:
            # Tracking success
            p1 = (int(bbox[0]), int(bbox[1]))
            p2 = (int(bbox[0] + bbox[2]), int(bbox[1] + bbox[3]))
            cv2.rectangle(frame, p1, p2, (255,0,0), 2, 1)
            x=(bbox[0]+bbox[2])/2
            y=(bbox[1]+bbox[3])/2
            xdata.append(x)
            ydata.append(y)
        else :
            # Tracking failure
            cv2.putText(frame, "Tracking failure detected", (100,110), cv2.FONT_HERSHEY_SIMPLEX, 0.75,(0,0,255),2)
 
        # Display tracker type on frame
        cv2.putText(frame, tracker_type + " Tracker", (100,20), cv2.FONT_HERSHEY_SIMPLEX, 0.75, (50,170,50),2);
     
        # Display FPS on frame
        cv2.putText(frame, "t : " + str(float(t)), (100,50), cv2.FONT_HERSHEY_SIMPLEX, 0.75, (50,170,50), 2);
        cv2.putText(frame, "x : " + str(int(x)) + " y : " + str(int(y)), (100,80), cv2.FONT_HERSHEY_SIMPLEX, 0.75, (50,170,50), 2);
        # Display result
        cv2.imshow("Tracking", frame)
 
        # Exit if ESC pressed
        k = cv2.waitKey(1) & 0xff
        if k == 27 : 
            break
            
sheet1.write(0,0,"t")
sheet1.write(0,1, "x")
sheet1.write(0,2, "y")

for x1 in xdata:
    sheet1.write(i+1, 1, x1)
    i+=1
for y1 in ydata:
    sheet1.write(j+1, 2, y1)
    j+=1
for t1 in tdata:
    sheet1.write(k+1, 0, t1)
    k+=1
    
book.save("drop_position_data.xls")
video.release()
cv2.destroyAllWindows()
            
            