#include <DetectionBasedTracker_jni.h>
#include <opencv2/core/core.hpp>
#include <opencv2/contrib/detection_based_tracker.hpp>

#include <string>
#include <vector>

#include <android/log.h>

#define LOG_TAG "FaceDetection/DetectionBasedTracker"
#define LOGD(...) ((void)__android_log_print(ANDROID_LOG_DEBUG, LOG_TAG, __VA_ARGS__))

using namespace std;
using namespace cv;

inline void vector_Rect_to_Mat(vector<Rect>& v_rect, Mat& mat)
{
    mat = Mat(v_rect, true);
}

class CascadeDetectorAdapter: public DetectionBasedTracker::IDetector
{
public:
    CascadeDetectorAdapter(cv::Ptr<cv::CascadeClassifier> detector):
    IDetector(),
    Detector(detector)
    {
	LOGD("CascadeDetectorAdapter::Detect::Detect");
	CV_Assert(!detector.empty());
    }
    
    void detect(const cv::Mat &Image, std::vector<cv::Rect> &objects)
    {
	LOGD("CascadeDetectorAdapter::Detect: begin");
	LOGD("CascadeDetectorAdapter::Detect: scaleFactor=%.2f, minNeighbours=%d, minObjSize=(%dx%d), maxObjSize=(%dx%d)", scaleFactor, minNeighbours, minObjSize.width, minObjSize.height, maxObjSize.width, maxObjSize.height);
	Detector->detectMultiScale(Image, objects, scaleFactor, minNeighbours, 0, minObjSize, maxObjSize);
	LOGD("CascadeDetectorAdapter::Detect: end");
    }
    
    virtual ~CascadeDetectorAdapter()
    {
	LOGD("CascadeDetectorAdapter::Detect::~Detect");
    }
    
private:
    CascadeDetectorAdapter();
    cv::Ptr<cv::CascadeClassifier> Detector;
};

struct DetectorAgregator
{
    cv::Ptr<CascadeDetectorAdapter> mainDetector;
    cv::Ptr<CascadeDetectorAdapter> trackingDetector;
    
    cv::Ptr<DetectionBasedTracker> tracker;
    DetectorAgregator(cv::Ptr<CascadeDetectorAdapter>& _mainDetector, cv::Ptr<CascadeDetectorAdapter>& _trackingDetector):
	mainDetector(_mainDetector),
	trackingDetector(_trackingDetector)
    {
	CV_Assert(!_mainDetector.empty());
	CV_Assert(!_trackingDetector.empty());
	
	DetectionBasedTracker::Parameters DetectorParams;
	tracker = new DetectionBasedTracker(mainDetector.ptr<DetectionBasedTracker::IDetector>(), trackingDetector.ptr<DetectionBasedTracker::IDetector>(), DetectorParams);
    }
};

JNIEXPORT jlong JNICALL Java_org_opencv_samples_fd_DetectionBasedTracker_nativeCreateObject
(JNIEnv * jenv, jclass, jstring jFileName, jint faceSize)
{
    const char* jnamestr = jenv->GetStringUTFChars(jFileName, NULL);
    string stdFileName(jnamestr);
    jlong result = 0;

    LOGD("Java_org_opencv_samples_fd_DetectionBasedTracker_nativeCreateObject");
    
    try
    {
	cv::Ptr<CascadeDetectorAdapter> mainDetector = new CascadeDetectorAdapter(new CascadeClassifier(stdFileName));
	cv::Ptr<CascadeDetectorAdapter> trackingDetector = new CascadeDetectorAdapter(new CascadeClassifier(stdFileName));
	result = (jlong)new DetectorAgregator(mainDetector, trackingDetector);
	if (faceSize > 0)
	{
	    mainDetector->setMinObjectSize(Size(faceSize, faceSize));
	    //trackingDetector->setMinObjectSize(Size(faceSize, faceSize));
	}
    }
    catch(cv::Exception e)
    {
	LOGD("nativeCreateObject catched cv::Exception: %s", e.what());
	jclass je = jenv->FindClass("org/opencv/core/CvException");
	if(!je)
	    je = jenv->FindClass("java/lang/Exception");
	jenv->ThrowNew(je, e.what());
    }
    catch (...)
    {
	LOGD("nativeCreateObject catched unknown exception");
	jclass je = jenv->FindClass("java/lang/Exception");
	jenv->ThrowNew(je, "Unknown exception in JNI code {Java_org_opencv_samples_fd_DetectionBasedTracker_nativeCreateObject(...)}");
	return 0;
    }

    return result;
}

JNIEXPORT void JNICALL Java_org_opencv_samples_fd_DetectionBasedTracker_nativeDestroyObject
(JNIEnv * jenv, jclass, jlong thiz)
{
    LOGD("Java_org_opencv_samples_fd_DetectionBasedTracker_nativeDestroyObject");
    
    try
    {
	((DetectorAgregator*)thiz)->tracker->stop();
	delete (DetectorAgregator*)thiz;
    }
    catch(cv::Exception e)
    {
	LOGD("nativeestroyObject catched cv::Exception: %s", e.what());
	jclass je = jenv->FindClass("org/opencv/core/CvException");
	if(!je)
	    je = jenv->FindClass("java/lang/Exception");
	jenv->ThrowNew(je, e.what());
    }
    catch (...)
    {
	LOGD("nativeDestroyObject catched unknown exception");
	jclass je = jenv->FindClass("java/lang/Exception");
	jenv->ThrowNew(je, "Unknown exception in JNI code {Java_org_opencv_samples_fd_DetectionBasedTracker_nativeDestroyObject(...)}");
    }
}

JNIEXPORT void JNICALL Java_org_opencv_samples_fd_DetectionBasedTracker_nativeStart
(JNIEnv * jenv, jclass, jlong thiz)
{
    LOGD("Java_org_opencv_samples_fd_DetectionBasedTracker_nativeStart");
    
    try
    {
	((DetectorAgregator*)thiz)->tracker->run();
    }
    catch(cv::Exception e)
    {
	LOGD("nativeStart catched cv::Exception: %s", e.what());
	jclass je = jenv->FindClass("org/opencv/core/CvException");
	if(!je)
	    je = jenv->FindClass("java/lang/Exception");
	jenv->ThrowNew(je, e.what());
    }
    catch (...)
    {
	LOGD("nativeStart catched unknown exception");
	jclass je = jenv->FindClass("java/lang/Exception");
	jenv->ThrowNew(je, "Unknown exception in JNI code {Java_org_opencv_samples_fd_DetectionBasedTracker_nativeStart(...)}");
    }
}

JNIEXPORT void JNICALL Java_org_opencv_samples_fd_DetectionBasedTracker_nativeStop
(JNIEnv * jenv, jclass, jlong thiz)
{
    LOGD("Java_org_opencv_samples_fd_DetectionBasedTracker_nativeStop");
    
    try
    {
	((DetectorAgregator*)thiz)->tracker->stop();
    }
    catch(cv::Exception e)
    {
	LOGD("nativeStop catched cv::Exception: %s", e.what());
	jclass je = jenv->FindClass("org/opencv/core/CvException");
	if(!je)
	    je = jenv->FindClass("java/lang/Exception");
	jenv->ThrowNew(je, e.what());
    }
    catch (...)
    {
	LOGD("nativeStop catched unknown exception");
	jclass je = jenv->FindClass("java/lang/Exception");
	jenv->ThrowNew(je, "Unknown exception in JNI code {Java_org_opencv_samples_fd_DetectionBasedTracker_nativeStop(...)}");
    }
}

JNIEXPORT void JNICALL Java_org_opencv_samples_fd_DetectionBasedTracker_nativeSetFaceSize
(JNIEnv * jenv, jclass, jlong thiz, jint faceSize)
{
    LOGD("Java_org_opencv_samples_fd_DetectionBasedTracker_nativeSetFaceSize -- BEGIN");
    
    try
    {
	if (faceSize > 0)
	{
	    ((DetectorAgregator*)thiz)->mainDetector->setMinObjectSize(Size(faceSize, faceSize));
	    //((DetectorAgregator*)thiz)->trackingDetector->setMinObjectSize(Size(faceSize, faceSize));
	}
    }
    catch(cv::Exception e)
    {
	LOGD("nativeStop catched cv::Exception: %s", e.what());
	jclass je = jenv->FindClass("org/opencv/core/CvException");
	if(!je)
	    je = jenv->FindClass("java/lang/Exception");
	jenv->ThrowNew(je, e.what());
    }
    catch (...)
    {
	LOGD("nativeSetFaceSize catched unknown exception");
	jclass je = jenv->FindClass("java/lang/Exception");
	jenv->ThrowNew(je, "Unknown exception in JNI code {Java_org_opencv_samples_fd_DetectionBasedTracker_nativeSetFaceSize(...)}");
    }
    LOGD("Java_org_opencv_samples_fd_DetectionBasedTracker_nativeSetFaceSize -- END");
}


JNIEXPORT void JNICALL Java_org_opencv_samples_fd_DetectionBasedTracker_nativeDetect
(JNIEnv * jenv, jclass, jlong thiz, jlong imageGray, jlong faces)
{
    LOGD("Java_org_opencv_samples_fd_DetectionBasedTracker_nativeDetect");
    
    try
    {
	vector<Rect> RectFaces;
	((DetectorAgregator*)thiz)->tracker->process(*((Mat*)imageGray));
	((DetectorAgregator*)thiz)->tracker->getObjects(RectFaces);
	*((Mat*)faces) = Mat(RectFaces, true);
    }
    catch(cv::Exception e)
    {
	LOGD("nativeCreateObject catched cv::Exception: %s", e.what());
	jclass je = jenv->FindClass("org/opencv/core/CvException");
	if(!je)
	    je = jenv->FindClass("java/lang/Exception");
	jenv->ThrowNew(je, e.what());
    }
    catch (...)
    {
	LOGD("nativeDetect catched unknown exception");
	jclass je = jenv->FindClass("java/lang/Exception");
	jenv->ThrowNew(je, "Unknown exception in JNI code {Java_org_opencv_samples_fd_DetectionBasedTracker_nativeDetect(...)}");
    }
    LOGD("Java_org_opencv_samples_fd_DetectionBasedTracker_nativeDetect END");
}
