camshift #2

#!/usr/bin/env python

# from multiprocessing import Process
from threading import Thread

import numpy as np

import cv2
import video

class App(object):
    def __init__(self,iv):
        self.cam = video.create_capture(iv)
        #self.cam = cv2.VideoCapture(iv)
        _ret, self.frame = self.cam.read()
        #self.frame=self.frame[60:400,90:520]
        cv2.namedWindow('camshift')
        cv2.setMouseCallback('camshift', self.onmouse)

        self.selection = None
        self.drag_start = None
        self.tracking_state = 0
        self.show_backproj = False
        self.hist = None
        self.track_window = None

    def onmouse(self, event, x, y, flags, param):
        # print event,x,y,flags,param
        x, y = np.int16([x, y]) # BUG
        if event == cv2.EVENT_LBUTTONDOWN:
            self.drag_start = (x, y)
            print 'DRAG START:',self.drag_start
            self.tracking_state = 0
        elif self.drag_start and event == cv2.EVENT_LBUTTONUP:
            h, w = self.frame.shape[:2]
            xo, yo = self.drag_start
            x0, y0 = np.maximum(0, np.minimum([xo, yo], [x, y]))
            x1, y1 = np.minimum([w, h], np.maximum([xo, yo], [x, y]))
            self.selection = None
            if x1-x0 > 0 and y1-y0 > 0:
                self.selection = (x0, y0, x1, y1)
            print 'DRAG STOP:',self.selection
            self.drag_start = None
            if self.selection is not None:
                self.tracking_state = 1



    def run(self):
        while True:
            _ret, self.frame = self.cam.read()
            #self.frame=self.frame[60:400,90:520]
            vis = self.frame.copy()
            hsv = cv2.cvtColor(self.frame, cv2.COLOR_BGR2HSV)
            mask = cv2.inRange(hsv, np.array((0., 60., 32.)), np.array((180., 255., 255.)))

            if self.selection:
                x0, y0, x1, y1 = self.selection
                self.track_window = (x0, y0, x1-x0, y1-y0)
                hsv_roi = hsv[y0:y1, x0:x1]
                mask_roi = mask[y0:y1, x0:x1]
                hist = cv2.calcHist( [hsv_roi], [0], mask_roi, [16], [0, 180] )
                cv2.normalize(hist, hist, 0, 255, cv2.NORM_MINMAX)
                self.hist = hist.reshape(-1)
                vis_roi = vis[y0:y1, x0:x1]
                cv2.bitwise_not(vis_roi, vis_roi)
                vis[mask == 0] = 0

            if self.tracking_state == 1:
                self.selection = None
                prob = cv2.calcBackProject([hsv], [0], self.hist, [0, 180], 1)
                prob &= mask
                term_crit = ( cv2.TERM_CRITERIA_EPS | cv2.TERM_CRITERIA_COUNT, 10, 1 )
                try:
                    track_box, self.track_window = cv2.CamShift(prob, self.track_window, term_crit)
                except Exception as exc:
                    print 'UHOH:',exc
                print track_box[0]
                if self.show_backproj:
                    vis[:] = prob[...,np.newaxis]
                try:
                    cv2.ellipse(vis, track_box, (0, 0, 255), 2)
                except Exception as exc:
                    print 'UHOH:',exc
                    print '\ttrack_box:',track_box
                    continue


            cv2.imshow('camshift', vis)

            ch = 0xFF & cv2.waitKey(5)
            if ch == 27:
                break
            if ch == ord('b'):
                self.show_backproj = not self.show_backproj
        cv2.destroyAllWindows()


if __name__ == '__main__':

    a=App(0)
    # b=App(2)
    aa=Thread(target=a.run)
    # bb=Thread(target=b.run)
    aa.start()
    # bb.start()