# Libraries
from scipy.spatial import distance as dist
from imutils.video import FileVideoStream
from imutils.video import VideoStream
from imutils import face_utils
from pygame import mixer
import numpy as np
import argparse
import imutils
import picamera
import time
import sys
import dlib
import cv2

mixer.init()

def eye_aspect_ratio(eye):
    # Comp euclidean dist between 2 sets of landmarks
    A = dist.euclidean(eye[1], eye[5])
    B = dist.euclidean(eye[2], eye[4])
    
    # Horiz euclidean distances
    C = dist.euclidean(eye[0], eye[3])
    
    # Compute abd return Aspect Ratio
    eAR = (A + B) / (2.0 * C)
    return eAR

# construct the argument parse and parse the arguments
ap = argparse.ArgumentParser()
#ap.add_argument("-p", "--shape-predictor", required=True,
#	help="path to facial landmark predictor")
ap.add_argument("-v", "--video", type=str, default="",
	help="path to input video file")
args = vars(ap.parse_args())

# Define eye AR thresholds that determine a "blink"
EYE_AR_THRESH = 0.15
EYE_AR_CONSEC_FRAMES = 1 # How long must AR be below thresh

# initialize counters and no of blinks
OPEN_CTR = 0
COUNTER = 0 # no of frames AR is less than thresh
TOTAL = 0 # no of blinks since run

# init dlib's face detector, create landmark predictor
print("[INFO] Loading facial landmark predictor...")
detector = dlib.get_frontal_face_detector()
predictor = dlib.shape_predictor("./shape_predictor_68_face_landmarks.dat")

# grab the indexes of the facial landmarks for the left and
# right eye, respectively
(lStart, lEnd) = face_utils.FACIAL_LANDMARKS_IDXS["left_eye"]
(rStart, rEnd) = face_utils.FACIAL_LANDMARKS_IDXS["right_eye"]

# start the video stream thread
print("[INFO] starting video stream thread...")
vs = FileVideoStream(args["video"]).start()
fileStream = True
# vs = VideoStream(src=0).start() [USE THIS LINE FOR WEBCAM]
vs = VideoStream(usePiCamera=True).start() # [USE THIS FOR RASP PI CAMERA]
fileStream = False # Comment this out if you have input a video file as demo
time.sleep(1.0)

mixer.music.load("just-do-it.mp3")

# loop over frames from the video stream
while True:
    # if this is a file video stream, then we need to check if
    # there any more frames left in the buffer to process
    if fileStream and not vs.more():
        break
    
    # grab the frame from the threaded video file stream, resize
    # it, and convert it to grayscale
    # channels)
    frame = vs.read()
    frame = imutils.resize(frame, width=450)
    gray = cv2.cvtColor(frame, cv2.COLOR_BGR2GRAY)
    
    # detect faces in the grayscale frame
    rects = detector(gray, 0)

    # loop over the face detections
    for rect in rects:
        # determine the facial landmarks for the face region, then
        # convert the facial landmark (x, y)-coordinates to a NumPy
        # array
        shape = predictor(gray, rect)
        shape = face_utils.shape_to_np(shape)
        
        # extract the left and right eye coordinates, then use the
        # coordinates to compute the eye aspect ratio for both eyes
        leftEye = shape[lStart:lEnd]
        rightEye = shape[rStart:rEnd]
        leftEAR = eye_aspect_ratio(leftEye)
        rightEAR = eye_aspect_ratio(rightEye)
        
        # average the eye aspect ratio together for both eyes
        ear = (leftEAR + rightEAR) / 2.0
        
        # compute the convex hull for the left and right eye, then
        # visualize each of the eyes
        leftEyeHull = cv2.convexHull(leftEye)
        rightEyeHull = cv2.convexHull(rightEye)
##        cv2.drawContours(frame, [leftEyeHull], -1, (0, 255, 0), 1)
##        cv2.drawContours(frame, [rightEyeHull], -1, (0, 255, 0), 1)

        # check to see if the eye aspect ratio is below the blink
        # threshold, and if so, increment the blink frame counter
        if ear < EYE_AR_THRESH:
            COUNTER += 1
            print("closed" + str(COUNTER))
        
        # otherwise, the eye aspect ratio is not below the blink
        # threshold
        else:
            
            # Count for how long open eye
            OPEN_CTR += 1
            print("open" + str(OPEN_CTR))
            
            # if the eyes were closed for a sufficient number of
            # then increment the total number of blinks
            if COUNTER >= EYE_AR_CONSEC_FRAMES:
                TOTAL += 1
                print("Blinks: {:d}".format(COUNTER,TOTAL))
                OPEN_CTR = 0
                
            if OPEN_CTR >= 6:
                mixer.music.play()
                OPEN_CTR = 0
                
            
            # reset the eye frame counter
            COUNTER = 0

        # draw the total number of blinks on the frame along with
        # the computed eye aspect ratio for the frame
##        cv2.putText(frame, "Blinks: {}".format(TOTAL), (10, 30),
##            cv2.FONT_HERSHEY_SIMPLEX, 0.7, (0, 0, 255), 2)
        
##        cv2.putText(frame, "EAR: {:.2f}".format(ear), (300, 30),
##            cv2.FONT_HERSHEY_SIMPLEX, 0.7, (0, 0, 255), 2)

    # show the frame
##    cv2.imshow("Frame", frame)
    key = cv2.waitKey(1) & 0xFF

    # if the `q` key was pressed, break from the loop
    if key == ord("q"):
        break

# do a bit of cleanup
cv2.destroyAllWindows()
vs.stop()
