]> rtime.felk.cvut.cz Git - opencv.git/blobdiff - opencv/src/cv/cvhaar.cpp
fixed MSVC 2008 compile errors and warnings
[opencv.git] / opencv / src / cv / cvhaar.cpp
index 4ae0c07af4e15ce0608ff2eb0ee1bb0277a0f0b2..20ea15f23a2dcfd522ed794cc57eb90b1fda8af0 100644 (file)
@@ -44,7 +44,7 @@
 #include "_cv.h"
 #include <stdio.h>
 
-#if CV_SSE2
+/*#if CV_SSE2
 #   if CV_SSE4 || defined __SSE4__
 #       include <smmintrin.h>
 #   else
@@ -54,7 +54,7 @@
 #if defined CV_ICC
 #   define CV_HAAR_USE_SSE 1
 #endif
-#endif
+#endif*/
 
 /* these settings affect the quality of detection: change with care */
 #define CV_ADJUST_FEATURES 1
@@ -133,24 +133,18 @@ icvCreateHaarClassifierCascade( int stage_count )
 {
     CvHaarClassifierCascade* cascade = 0;
 
-    CV_FUNCNAME( "icvCreateHaarClassifierCascade" );
-
-    __BEGIN__;
-
     int block_size = sizeof(*cascade) + stage_count*sizeof(*cascade->stage_classifier);
 
     if( stage_count <= 0 )
-        CV_ERROR( CV_StsOutOfRange, "Number of stages should be positive" );
+        CV_Error( CV_StsOutOfRange, "Number of stages should be positive" );
 
-    CV_CALL( cascade = (CvHaarClassifierCascade*)cvAlloc( block_size ));
+    cascade = (CvHaarClassifierCascade*)cvAlloc( block_size );
     memset( cascade, 0, block_size );
 
     cascade->stage_classifier = (CvHaarStageClassifier*)(cascade + 1);
     cascade->flags = CV_HAAR_MAGIC_VAL;
     cascade->count = stage_count;
 
-    __END__;
-
     return cascade;
 }
 
@@ -186,10 +180,6 @@ icvCreateHidHaarClassifierCascade( CvHaarClassifierCascade* cascade )
 
     CvHidHaarClassifierCascade* out = 0;
 
-    CV_FUNCNAME( "icvCreateHidHaarClassifierCascade" );
-
-    __BEGIN__;
-
     int i, j, k, l;
     int datasize;
     int total_classifiers = 0;
@@ -202,16 +192,16 @@ icvCreateHidHaarClassifierCascade( CvHaarClassifierCascade* cascade )
     int max_count = 0;
 
     if( !CV_IS_HAAR_CLASSIFIER(cascade) )
-        CV_ERROR( !cascade ? CV_StsNullPtr : CV_StsBadArg, "Invalid classifier pointer" );
+        CV_Error( !cascade ? CV_StsNullPtr : CV_StsBadArg, "Invalid classifier pointer" );
 
     if( cascade->hid_cascade )
-        CV_ERROR( CV_StsError, "hid_cascade has been already created" );
+        CV_Error( CV_StsError, "hid_cascade has been already created" );
 
     if( !cascade->stage_classifier )
-        CV_ERROR( CV_StsNullPtr, "" );
+        CV_Error( CV_StsNullPtr, "" );
 
     if( cascade->count <= 0 )
-        CV_ERROR( CV_StsOutOfRange, "Negative number of cascade stages" );
+        CV_Error( CV_StsOutOfRange, "Negative number of cascade stages" );
 
     orig_window_size = cascade->orig_window_size;
 
@@ -226,7 +216,7 @@ icvCreateHidHaarClassifierCascade( CvHaarClassifierCascade* cascade )
         {
             sprintf( errorstr, "header of the stage classifier #%d is invalid "
                      "(has null pointers or non-positive classfier count)", i );
-            CV_ERROR( CV_StsError, errorstr );
+            CV_Error( CV_StsError, errorstr );
         }
 
         max_count = MAX( max_count, stage_classifier->count );
@@ -258,7 +248,7 @@ icvCreateHidHaarClassifierCascade( CvHaarClassifierCascade* cascade )
                             sprintf( errorstr, "rectangle #%d of the classifier #%d of "
                                      "the stage classifier #%d is not inside "
                                      "the reference (original) cascade window", k, j, i );
-                            CV_ERROR( CV_StsNullPtr, errorstr );
+                            CV_Error( CV_StsNullPtr, errorstr );
                         }
                     }
                 }
@@ -273,7 +263,7 @@ icvCreateHidHaarClassifierCascade( CvHaarClassifierCascade* cascade )
                sizeof(CvHidHaarTreeNode) * total_nodes +
                sizeof(void*)*(total_nodes + total_classifiers);
 
-    CV_CALL( out = (CvHidHaarClassifierCascade*)cvAlloc( datasize ));
+    out = (CvHidHaarClassifierCascade*)cvAlloc( datasize );
     memset( out, 0, sizeof(*out) );
 
     /* init header */
@@ -344,7 +334,6 @@ icvCreateHidHaarClassifierCascade( CvHaarClassifierCascade* cascade )
     }
 
 #ifdef HAVE_IPP
-    {
     int can_use_ipp = !out->has_tilted_features && !out->is_tree && out->is_stump_based;
 
     if( can_use_ipp )
@@ -353,15 +342,15 @@ icvCreateHidHaarClassifierCascade( CvHaarClassifierCascade* cascade )
         float ipp_weight_scale=(float)(1./((orig_window_size.width-icv_object_win_border*2)*
             (orig_window_size.height-icv_object_win_border*2)));
 
-        CV_CALL( out->ipp_stages = (void**)cvAlloc( ipp_datasize ));
+        out->ipp_stages = (void**)cvAlloc( ipp_datasize );
         memset( out->ipp_stages, 0, ipp_datasize );
 
-        CV_CALL( ipp_features = (CvRect*)cvAlloc( max_count*3*sizeof(ipp_features[0]) ));
-        CV_CALL( ipp_weights = (float*)cvAlloc( max_count*3*sizeof(ipp_weights[0]) ));
-        CV_CALL( ipp_thresholds = (float*)cvAlloc( max_count*sizeof(ipp_thresholds[0]) ));
-        CV_CALL( ipp_val1 = (float*)cvAlloc( max_count*sizeof(ipp_val1[0]) ));
-        CV_CALL( ipp_val2 = (float*)cvAlloc( max_count*sizeof(ipp_val2[0]) ));
-        CV_CALL( ipp_counts = (int*)cvAlloc( max_count*sizeof(ipp_counts[0]) ));
+        ipp_features = (CvRect*)cvAlloc( max_count*3*sizeof(ipp_features[0]) );
+        ipp_weights = (float*)cvAlloc( max_count*3*sizeof(ipp_weights[0]) );
+        ipp_thresholds = (float*)cvAlloc( max_count*sizeof(ipp_thresholds[0]) );
+        ipp_val1 = (float*)cvAlloc( max_count*sizeof(ipp_val1[0]) );
+        ipp_val2 = (float*)cvAlloc( max_count*sizeof(ipp_val2[0]) );
+        ipp_counts = (int*)cvAlloc( max_count*sizeof(ipp_counts[0]) );
 
         for( i = 0; i < cascade->count; i++ )
         {
@@ -398,17 +387,11 @@ icvCreateHidHaarClassifierCascade( CvHaarClassifierCascade* cascade )
             cvFree( &out->ipp_stages );
         }
     }
-    }
 #endif
 
     cascade->hid_cascade = out;
     assert( (char*)haar_node_ptr - (char*)out <= datasize );
 
-    __END__;
-
-    if( cvGetErrStatus() < 0 )
-        icvReleaseHidHaarClassifierCascade( &out );
-
     cvFree( &ipp_features );
     cvFree( &ipp_weights );
     cvFree( &ipp_thresholds );
@@ -437,58 +420,54 @@ cvSetImagesForHaarClassifierCascade( CvHaarClassifierCascade* _cascade,
                                      const CvArr* _tilted_sum,
                                      double scale )
 {
-    CV_FUNCNAME("cvSetImagesForHaarClassifierCascade");
-
-    __BEGIN__;
-
     CvMat sum_stub, *sum = (CvMat*)_sum;
     CvMat sqsum_stub, *sqsum = (CvMat*)_sqsum;
     CvMat tilted_stub, *tilted = (CvMat*)_tilted_sum;
     CvHidHaarClassifierCascade* cascade;
     int coi0 = 0, coi1 = 0;
     int i;
-    CvRect equ_rect;
+    CvRect equRect;
     double weight_scale;
 
     if( !CV_IS_HAAR_CLASSIFIER(_cascade) )
-        CV_ERROR( !_cascade ? CV_StsNullPtr : CV_StsBadArg, "Invalid classifier pointer" );
+        CV_Error( !_cascade ? CV_StsNullPtr : CV_StsBadArg, "Invalid classifier pointer" );
 
     if( scale <= 0 )
-        CV_ERROR( CV_StsOutOfRange, "Scale must be positive" );
+        CV_Error( CV_StsOutOfRange, "Scale must be positive" );
 
-    CV_CALL( sum = cvGetMat( sum, &sum_stub, &coi0 ));
-    CV_CALL( sqsum = cvGetMat( sqsum, &sqsum_stub, &coi1 ));
+    sum = cvGetMat( sum, &sum_stub, &coi0 );
+    sqsum = cvGetMat( sqsum, &sqsum_stub, &coi1 );
 
     if( coi0 || coi1 )
-        CV_ERROR( CV_BadCOI, "COI is not supported" );
+        CV_Error( CV_BadCOI, "COI is not supported" );
 
     if( !CV_ARE_SIZES_EQ( sum, sqsum ))
-        CV_ERROR( CV_StsUnmatchedSizes, "All integral images must have the same size" );
+        CV_Error( CV_StsUnmatchedSizes, "All integral images must have the same size" );
 
     if( CV_MAT_TYPE(sqsum->type) != CV_64FC1 ||
         CV_MAT_TYPE(sum->type) != CV_32SC1 )
-        CV_ERROR( CV_StsUnsupportedFormat,
+        CV_Error( CV_StsUnsupportedFormat,
         "Only (32s, 64f, 32s) combination of (sum,sqsum,tilted_sum) formats is allowed" );
 
     if( !_cascade->hid_cascade )
-        CV_CALL( icvCreateHidHaarClassifierCascade(_cascade) );
+        icvCreateHidHaarClassifierCascade(_cascade);
 
     cascade = _cascade->hid_cascade;
 
     if( cascade->has_tilted_features )
     {
-        CV_CALL( tilted = cvGetMat( tilted, &tilted_stub, &coi1 ));
+        tilted = cvGetMat( tilted, &tilted_stub, &coi1 );
 
         if( CV_MAT_TYPE(tilted->type) != CV_32SC1 )
-            CV_ERROR( CV_StsUnsupportedFormat,
+            CV_Error( CV_StsUnsupportedFormat,
             "Only (32s, 64f, 32s) combination of (sum,sqsum,tilted_sum) formats is allowed" );
 
         if( sum->step != tilted->step )
-            CV_ERROR( CV_StsUnmatchedSizes,
+            CV_Error( CV_StsUnmatchedSizes,
             "Sum and tilted_sum must have the same stride (step, widthStep)" );
 
         if( !CV_ARE_SIZES_EQ( sum, tilted ))
-            CV_ERROR( CV_StsUnmatchedSizes, "All integral images must have the same size" );
+            CV_Error( CV_StsUnmatchedSizes, "All integral images must have the same size" );
         cascade->tilted = *tilted;
     }
 
@@ -499,31 +478,26 @@ cvSetImagesForHaarClassifierCascade( CvHaarClassifierCascade* _cascade,
     cascade->sum = *sum;
     cascade->sqsum = *sqsum;
 
-    equ_rect.x = equ_rect.y = cvRound(scale);
-    equ_rect.width = cvRound((_cascade->orig_window_size.width-2)*scale);
-    equ_rect.height = cvRound((_cascade->orig_window_size.height-2)*scale);
-    weight_scale = 1./(equ_rect.width*equ_rect.height);
+    equRect.x = equRect.y = cvRound(scale);
+    equRect.width = cvRound((_cascade->orig_window_size.width-2)*scale);
+    equRect.height = cvRound((_cascade->orig_window_size.height-2)*scale);
+    weight_scale = 1./(equRect.width*equRect.height);
     cascade->inv_window_area = weight_scale;
 
-    cascade->p0 = sum_elem_ptr(*sum, equ_rect.y, equ_rect.x);
-    cascade->p1 = sum_elem_ptr(*sum, equ_rect.y, equ_rect.x + equ_rect.width );
-    cascade->p2 = sum_elem_ptr(*sum, equ_rect.y + equ_rect.height, equ_rect.x );
-    cascade->p3 = sum_elem_ptr(*sum, equ_rect.y + equ_rect.height,
-                                     equ_rect.x + equ_rect.width );
+    cascade->p0 = sum_elem_ptr(*sum, equRect.y, equRect.x);
+    cascade->p1 = sum_elem_ptr(*sum, equRect.y, equRect.x + equRect.width );
+    cascade->p2 = sum_elem_ptr(*sum, equRect.y + equRect.height, equRect.x );
+    cascade->p3 = sum_elem_ptr(*sum, equRect.y + equRect.height,
+                                     equRect.x + equRect.width );
 
-    cascade->pq0 = sqsum_elem_ptr(*sqsum, equ_rect.y, equ_rect.x);
-    cascade->pq1 = sqsum_elem_ptr(*sqsum, equ_rect.y, equ_rect.x + equ_rect.width );
-    cascade->pq2 = sqsum_elem_ptr(*sqsum, equ_rect.y + equ_rect.height, equ_rect.x );
-    cascade->pq3 = sqsum_elem_ptr(*sqsum, equ_rect.y + equ_rect.height,
-                                          equ_rect.x + equ_rect.width );
+    cascade->pq0 = sqsum_elem_ptr(*sqsum, equRect.y, equRect.x);
+    cascade->pq1 = sqsum_elem_ptr(*sqsum, equRect.y, equRect.x + equRect.width );
+    cascade->pq2 = sqsum_elem_ptr(*sqsum, equRect.y + equRect.height, equRect.x );
+    cascade->pq3 = sqsum_elem_ptr(*sqsum, equRect.y + equRect.height,
+                                          equRect.x + equRect.width );
 
     /* init pointers in haar features according to real window size and
        given image pointers */
-    {
-#ifdef _OPENMP
-    int max_threads = cvGetNumThreads();
-    #pragma omp parallel for num_threads(max_threads) schedule(dynamic)
-#endif // _OPENMP
     for( i = 0; i < _cascade->count; i++ )
     {
         int j, k, l;
@@ -539,13 +513,12 @@ cvSetImagesForHaarClassifierCascade( CvHaarClassifierCascade* _cascade,
                     &cascade->stage_classifier[i].classifier[j].node[l].feature;
                 double sum0 = 0, area0 = 0;
                 CvRect r[3];
-#if CV_ADJUST_FEATURES
+
                 int base_w = -1, base_h = -1;
                 int new_base_w = 0, new_base_h = 0;
                 int kx, ky;
                 int flagx = 0, flagy = 0;
                 int x0 = 0, y0 = 0;
-#endif
                 int nr;
 
                 /* align blocks */
@@ -553,18 +526,15 @@ cvSetImagesForHaarClassifierCascade( CvHaarClassifierCascade* _cascade,
                 {
                     if( !hidfeature->rect[k].p0 )
                         break;
-#if CV_ADJUST_FEATURES
                     r[k] = feature->rect[k].r;
                     base_w = (int)CV_IMIN( (unsigned)base_w, (unsigned)(r[k].width-1) );
                     base_w = (int)CV_IMIN( (unsigned)base_w, (unsigned)(r[k].x - r[0].x-1) );
                     base_h = (int)CV_IMIN( (unsigned)base_h, (unsigned)(r[k].height-1) );
                     base_h = (int)CV_IMIN( (unsigned)base_h, (unsigned)(r[k].y - r[0].y-1) );
-#endif
                 }
 
                 nr = k;
 
-#if CV_ADJUST_FEATURES
                 base_w += 1;
                 base_h += 1;
                 kx = r[0].width / base_w;
@@ -583,34 +553,29 @@ cvSetImagesForHaarClassifierCascade( CvHaarClassifierCascade* _cascade,
                     new_base_h = cvRound( r[0].height * scale ) / ky;
                     y0 = cvRound( r[0].y * scale );
                 }
-#endif
 
                 for( k = 0; k < nr; k++ )
                 {
                     CvRect tr;
                     double correction_ratio;
 
-#if CV_ADJUST_FEATURES
                     if( flagx )
                     {
                         tr.x = (r[k].x - r[0].x) * new_base_w / base_w + x0;
                         tr.width = r[k].width * new_base_w / base_w;
                     }
                     else
-#endif
                     {
                         tr.x = cvRound( r[k].x * scale );
                         tr.width = cvRound( r[k].width * scale );
                     }
 
-#if CV_ADJUST_FEATURES
                     if( flagy )
                     {
                         tr.y = (r[k].y - r[0].y) * new_base_h / base_h + y0;
                         tr.height = r[k].height * new_base_h / base_h;
                     }
                     else
-#endif
                     {
                         tr.y = cvRound( r[k].y * scale );
                         tr.height = cvRound( r[k].height * scale );
@@ -622,7 +587,7 @@ cvSetImagesForHaarClassifierCascade( CvHaarClassifierCascade* _cascade,
                     const float orig_feature_size =  (float)(feature->rect[k].r.width)*feature->rect[k].r.height;
                     const float orig_norm_size = (float)(_cascade->orig_window_size.width)*(_cascade->orig_window_size.height);
                     const float feature_size = float(tr.width*tr.height);
-                    //const float normSize    = float(equ_rect.width*equ_rect.height);
+                    //const float normSize    = float(equRect.width*equRect.height);
                     float target_ratio = orig_feature_size / orig_norm_size;
                     //float isRatio = featureSize / normSize;
                     //correctionRatio = targetRatio / isRatio / normSize;
@@ -661,9 +626,6 @@ cvSetImagesForHaarClassifierCascade( CvHaarClassifierCascade* _cascade,
             } /* l */
         } /* j */
     }
-    }
-
-    __END__;
 }
 
 
@@ -696,9 +658,6 @@ cvRunHaarClassifierCascade( const CvHaarClassifierCascade* _cascade,
                             CvPoint pt, int start_stage )
 {
     int result = -1;
-    CV_FUNCNAME("cvRunHaarClassifierCascade");
-
-    __BEGIN__;
 
     int p_offset, pq_offset;
     int i, j;
@@ -706,17 +665,17 @@ cvRunHaarClassifierCascade( const CvHaarClassifierCascade* _cascade,
     CvHidHaarClassifierCascade* cascade;
 
     if( !CV_IS_HAAR_CLASSIFIER(_cascade) )
-        CV_ERROR( !_cascade ? CV_StsNullPtr : CV_StsBadArg, "Invalid cascade pointer" );
+        CV_Error( !_cascade ? CV_StsNullPtr : CV_StsBadArg, "Invalid cascade pointer" );
 
     cascade = _cascade->hid_cascade;
     if( !cascade )
-        CV_ERROR( CV_StsNullPtr, "Hidden cascade has not been created.\n"
+        CV_Error( CV_StsNullPtr, "Hidden cascade has not been created.\n"
             "Use cvSetImagesForHaarClassifierCascade" );
 
     if( pt.x < 0 || pt.y < 0 ||
         pt.x + _cascade->real_window_size.width >= cascade->sum.width-2 ||
         pt.y + _cascade->real_window_size.height >= cascade->sum.height-2 )
-        EXIT;
+        return -1;
 
     p_offset = pt.y * (cascade->sum.step/sizeof(sumtype)) + pt.x;
     pq_offset = pt.y * (cascade->sqsum.step/sizeof(sqsumtype)) + pt.x;
@@ -755,10 +714,7 @@ cvRunHaarClassifierCascade( const CvHaarClassifierCascade* _cascade,
             {
                 while( ptr && ptr->next == NULL ) ptr = ptr->parent;
                 if( ptr == NULL )
-                {
-                    result = 0;
-                    EXIT;
-                }
+                    return 0;
                 ptr = ptr->next;
             }
         }
@@ -833,10 +789,7 @@ cvRunHaarClassifierCascade( const CvHaarClassifierCascade* _cascade,
             __m128d i_threshold = _mm_set_sd(cascade->stage_classifier[i].threshold);
             if( _mm_comilt_sd(stage_sum, i_threshold) )
 #endif
-            {
-                result = -i;
-                EXIT;
-            }
+                return -i;
         }
     }
     else
@@ -853,154 +806,274 @@ cvRunHaarClassifierCascade( const CvHaarClassifierCascade* _cascade,
             }
 
             if( stage_sum < cascade->stage_classifier[i].threshold )
-            {
-                result = -i;
-                EXIT;
-            }
+                return -i;
         }
     }
 
-    result = 1;
-
-    __END__;
-
-    return result;
+    return 1;
 }
 
 
-static int is_equal( const void* _r1, const void* _r2, void* )
+namespace cv
 {
-    const CvRect* r1 = (const CvRect*)_r1;
-    const CvRect* r2 = (const CvRect*)_r2;
-    int distance = cvRound(r1->width*0.2);
-
-    return r2->x <= r1->x + distance &&
-           r2->x >= r1->x - distance &&
-           r2->y <= r1->y + distance &&
-           r2->y >= r1->y - distance &&
-           r2->width <= cvRound( r1->width * 1.2 ) &&
-           cvRound( r2->width * 1.2 ) >= r1->width;
-}
 
+struct HaarDetectObjects_ScaleImage_Invoker
+{
+    HaarDetectObjects_ScaleImage_Invoker( const CvHaarClassifierCascade* _cascade,
+                                          int _stripSize, double _factor,
+                                          const Mat& _sum1, const Mat& _sqsum1, Mat* _norm1,
+                                          Mat* _mask1, Rect _equRect, ConcurrentRectVector& _vec )
+    {
+        cascade = _cascade;
+        stripSize = _stripSize;
+        factor = _factor;
+        sum1 = _sum1;
+        sqsum1 = _sqsum1;
+        norm1 = _norm1;
+        mask1 = _mask1;
+        equRect = _equRect;
+        vec = &_vec;
+    }
+    
+    void operator()( const BlockedRange& range ) const
+    {
+        Size winSize0 = cascade->orig_window_size;
+        Size winSize(cvRound(winSize0.width*factor), cvRound(winSize0.height*factor));
+        int y1 = range.begin()*stripSize, y2 = min(range.end()*stripSize, sum1.rows - 1 - winSize0.height);
+        Size ssz(sum1.cols - 1 - winSize0.width, y2 - y1);
+        int x, y, ystep = factor > 2 ? 1 : 2;
+        
+    #ifdef HAVE_IPP
+        if( cascade->hid_cascade->ipp_stages )
+        {
+            IppiRect iequRect = {equRect.x, equRect.y, equRect.width, equRect.height};
+            ippiRectStdDev_32f_C1R(sum1.ptr<float>(y1), sum1.step,
+                                   sqsum1.ptr<double>(y1), sqsum1.step,
+                                   norm1->ptr<float>(y1), norm1->step,
+                                   ippiSize(ssz.width, ssz.height), iequRect );
+            
+            int positive = (ssz.width/ystep)*((ssz.height + ystep-1)/ystep);
+
+            if( ystep == 1 )
+                (*mask1) = Scalar::all(1);
+            else
+                for( y = y1; y < y2; y++ )
+                {
+                    uchar* mask1row = mask1->ptr(y);
+                    memset( mask1row, 0, ssz.width );
+                    
+                    if( y % ystep == 0 )
+                        for( x = 0; x < ssz.width; x += ystep )
+                            mask1row[x] = (uchar)1;
+                }
+            
+            for( int j = 0; j < cascade->count; j++ )
+            {
+                if( ippiApplyHaarClassifier_32f_C1R(
+                            sum1.ptr<float>(y1), sum1.step,
+                            norm1->ptr<float>(y1), norm1->step,
+                            mask1->ptr<uchar>(y1), mask1->step,
+                            ippiSize(ssz.width, ssz.height), &positive,
+                            cascade->hid_cascade->stage_classifier[j].threshold,
+                            (IppiHaarClassifier_32f*)cascade->hid_cascade->ipp_stages[j]) < 0 )
+                    positive = 0;
+                if( positive <= 0 )
+                    break;
+            }
+            
+            if( positive > 0 )
+                for( y = y1; y < y2; y += ystep )
+                {
+                    uchar* mask1row = mask1->ptr(y);
+                    for( x = 0; x < ssz.width; x += ystep )
+                        if( mask1row[x] != 0 )
+                        {
+                            vec->push_back(Rect(cvRound(x*factor), cvRound(y*factor),
+                                                winSize.width, winSize.height));
+                            if( --positive == 0 )
+                                break;
+                        }
+                    if( positive == 0 )
+                        break;
+                }
+        }
+        else
+#endif
+            for( y = y1; y < y2; y += ystep )
+                for( x = 0; x < ssz.width; x += ystep )
+                {
+                    if( cvRunHaarClassifierCascade( cascade, cvPoint(x,y), 0 ) > 0 )
+                        vec->push_back(Rect(cvRound(x*factor), cvRound(y*factor),
+                                            winSize.width, winSize.height)); 
+                }
+    }
+    
+    const CvHaarClassifierCascade* cascade;
+    int stripSize;
+    double factor;
+    Mat sum1, sqsum1, *norm1, *mask1;
+    Rect equRect;
+    ConcurrentRectVector* vec;
+};
+    
 
-#define VERY_ROUGH_SEARCH 0
+struct HaarDetectObjects_ScaleCascade_Invoker
+{
+    HaarDetectObjects_ScaleCascade_Invoker( const CvHaarClassifierCascade* _cascade,
+                                            Size _winsize, const Range& _xrange, double _ystep,
+                                            size_t _sumstep, const int** _p, const int** _pq,
+                                            ConcurrentRectVector& _vec )
+    {
+        cascade = _cascade;
+        winsize = _winsize;
+        xrange = _xrange;
+        ystep = _ystep;
+        sumstep = _sumstep;
+        p = _p; pq = _pq;
+        vec = &_vec;
+    }
+    
+    void operator()( const BlockedRange& range ) const
+    {
+        int iy, startY = range.begin(), endY = range.end();
+        const int *p0 = p[0], *p1 = p[1], *p2 = p[2], *p3 = p[3];
+        const int *pq0 = pq[0], *pq1 = pq[1], *pq2 = pq[2], *pq3 = pq[3];
+        bool doCannyPruning = p0 != 0;
+        int sstep = sumstep/sizeof(p0[0]);
+        
+        for( iy = startY; iy < endY; iy++ )
+        {
+            int ix, y = cvRound(iy*ystep), ixstep = 1;
+            for( ix = xrange.start; ix < xrange.end; ix += ixstep )
+            {
+                int x = cvRound(ix*ystep); // it should really be ystep, not ixstep
+                
+                if( doCannyPruning )
+                {
+                    int offset = y*sstep + x;
+                    int s = p0[offset] - p1[offset] - p2[offset] + p3[offset];
+                    int sq = pq0[offset] - pq1[offset] - pq2[offset] + pq3[offset];
+                    if( s < 100 || sq < 20 )
+                    {
+                        ixstep = 2;
+                        continue;
+                    }
+                }
+                
+                int result = cvRunHaarClassifierCascade( cascade, cvPoint(x, y), 0 );
+                if( result > 0 )
+                    vec->push_back(Rect(x, y, winsize.width, winsize.height));
+                ixstep = result != 0 ? 1 : 2;
+            }
+        }
+    }
+    
+    const CvHaarClassifierCascade* cascade;
+    double ystep;
+    size_t sumstep;
+    Size winsize;
+    Range xrange;
+    const int** p;
+    const int** pq;
+    ConcurrentRectVector* vec;
+};
+    
+    
+}
+    
 
 CV_IMPL CvSeq*
 cvHaarDetectObjects( const CvArr* _img,
                      CvHaarClassifierCascade* cascade,
-                     CvMemStorage* storage, double scale_factor,
-                     int min_neighbors, int flags, CvSize min_size )
+                     CvMemStorage* storage, double scaleFactor,
+                     int minNeighbors, int flags, CvSize minSize )
 {
-    int split_stage = 2;
-
+    const double GROUP_EPS = 0.2;
     CvMat stub, *img = (CvMat*)_img;
-    CvMat *temp = 0, *sum = 0, *tilted = 0, *sqsum = 0, *norm_img = 0, *sumcanny = 0, *img_small = 0;
+    cv::Ptr<CvMat> temp, sum, tilted, sqsum, normImg, sumcanny, imgSmall;
     CvSeq* result_seq = 0;
-    CvMemStorage* temp_storage = 0;
-    CvAvgComp* comps = 0;
-    CvSeq* seq_thread[CV_MAX_THREADS] = {0};
-    int i, max_threads = 0;
-
-    CV_FUNCNAME( "cvHaarDetectObjects" );
+    cv::Ptr<CvMemStorage> temp_storage;
 
-    __BEGIN__;
-
-    CvSeq *seq = 0, *seq2 = 0, *idx_seq = 0, *big_seq = 0;
-    CvAvgComp result_comp = {{0,0,0,0},0};
+    cv::ConcurrentRectVector allCandidates;
+    std::vector<cv::Rect> rectList;
+    std::vector<int> rweights;
     double factor;
-    int npass = 2, coi;
-    bool do_canny_pruning = (flags & CV_HAAR_DO_CANNY_PRUNING) != 0;
-    bool find_biggest_object = (flags & CV_HAAR_FIND_BIGGEST_OBJECT) != 0;
-    bool rough_search = (flags & CV_HAAR_DO_ROUGH_SEARCH) != 0;
+    int coi;
+    bool doCannyPruning = (flags & CV_HAAR_DO_CANNY_PRUNING) != 0;
+    bool findBiggestObject = (flags & CV_HAAR_FIND_BIGGEST_OBJECT) != 0;
+    bool roughSearch = (flags & CV_HAAR_DO_ROUGH_SEARCH) != 0;
 
     if( !CV_IS_HAAR_CLASSIFIER(cascade) )
-        CV_ERROR( !cascade ? CV_StsNullPtr : CV_StsBadArg, "Invalid classifier cascade" );
+        CV_Error( !cascade ? CV_StsNullPtr : CV_StsBadArg, "Invalid classifier cascade" );
 
     if( !storage )
-        CV_ERROR( CV_StsNullPtr, "Null storage pointer" );
+        CV_Error( CV_StsNullPtr, "Null storage pointer" );
 
-    CV_CALL( img = cvGetMat( img, &stub, &coi ));
+    img = cvGetMat( img, &stub, &coi );
     if( coi )
-        CV_ERROR( CV_BadCOI, "COI is not supported" );
+        CV_Error( CV_BadCOI, "COI is not supported" );
 
     if( CV_MAT_DEPTH(img->type) != CV_8U )
-        CV_ERROR( CV_StsUnsupportedFormat, "Only 8-bit images are supported" );
+        CV_Error( CV_StsUnsupportedFormat, "Only 8-bit images are supported" );
     
-    if( scale_factor <= 1 )
-        CV_ERROR( CV_StsOutOfRange, "scale factor must be > 1" );
+    if( scaleFactor <= 1 )
+        CV_Error( CV_StsOutOfRange, "scale factor must be > 1" );
 
-    if( find_biggest_object )
+    if( findBiggestObject )
         flags &= ~CV_HAAR_SCALE_IMAGE;
 
-    CV_CALL( temp = cvCreateMat( img->rows, img->cols, CV_8UC1 ));
-    CV_CALL( sum = cvCreateMat( img->rows + 1, img->cols + 1, CV_32SC1 ));
-    CV_CALL( sqsum = cvCreateMat( img->rows + 1, img->cols + 1, CV_64FC1 ));
-    CV_CALL( temp_storage = cvCreateChildMemStorage( storage ));
+    temp = cvCreateMat( img->rows, img->cols, CV_8UC1 );
+    sum = cvCreateMat( img->rows + 1, img->cols + 1, CV_32SC1 );
+    sqsum = cvCreateMat( img->rows + 1, img->cols + 1, CV_64FC1 );
 
     if( !cascade->hid_cascade )
-        CV_CALL( icvCreateHidHaarClassifierCascade(cascade) );
+        icvCreateHidHaarClassifierCascade(cascade);
 
     if( cascade->hid_cascade->has_tilted_features )
         tilted = cvCreateMat( img->rows + 1, img->cols + 1, CV_32SC1 );
 
-    seq = cvCreateSeq( 0, sizeof(CvSeq), sizeof(CvRect), temp_storage );
-    seq2 = cvCreateSeq( 0, sizeof(CvSeq), sizeof(CvAvgComp), temp_storage );
     result_seq = cvCreateSeq( 0, sizeof(CvSeq), sizeof(CvAvgComp), storage );
 
-    max_threads = cvGetNumThreads();
-    if( max_threads > 1 )
-        for( i = 0; i < max_threads; i++ )
-        {
-            CvMemStorage* temp_storage_thread;
-            CV_CALL( temp_storage_thread = cvCreateMemStorage(0));
-            CV_CALL( seq_thread[i] = cvCreateSeq( 0, sizeof(CvSeq),
-                sizeof(CvRect), temp_storage_thread ));
-        }
-    else
-        seq_thread[0] = seq;
-
     if( CV_MAT_CN(img->type) > 1 )
     {
         cvCvtColor( img, temp, CV_BGR2GRAY );
         img = temp;
     }
 
-    if( flags & CV_HAAR_FIND_BIGGEST_OBJECT )
+    if( findBiggestObject )
         flags &= ~(CV_HAAR_SCALE_IMAGE|CV_HAAR_DO_CANNY_PRUNING);
 
     if( flags & CV_HAAR_SCALE_IMAGE )
     {
-        CvSize win_size0 = cascade->orig_window_size;
+        CvSize winSize0 = cascade->orig_window_size;
 #ifdef HAVE_IPP
         int use_ipp = cascade->hid_cascade->ipp_stages != 0;
 
         if( use_ipp )
-            CV_CALL( norm_img = cvCreateMat( img->rows, img->cols, CV_32FC1 ));
+            normImg = cvCreateMat( img->rows, img->cols, CV_32FC1 );
 #endif
-        CV_CALL( img_small = cvCreateMat( img->rows + 1, img->cols + 1, CV_8UC1 ));
+        imgSmall = cvCreateMat( img->rows + 1, img->cols + 1, CV_8UC1 );
 
-        for( factor = 1; ; factor *= scale_factor )
+        for( factor = 1; ; factor *= scaleFactor )
         {
-            int strip_count, strip_size;
-            int ystep = factor > 2. ? 1 : 2;
-            CvSize win_size = { cvRound(win_size0.width*factor),
-                                cvRound(win_size0.height*factor) };
+            CvSize winSize = { cvRound(winSize0.width*factor),
+                                cvRound(winSize0.height*factor) };
             CvSize sz = { cvRound( img->cols/factor ), cvRound( img->rows/factor ) };
-            CvSize sz1 = { sz.width - win_size0.width, sz.height - win_size0.height };
-#ifdef HAVE_IPP
-            IppiRect equ_rect = { icv_object_win_border, icv_object_win_border,
-                win_size0.width - icv_object_win_border*2,
-                win_size0.height - icv_object_win_border*2 };
-#endif
+            CvSize sz1 = { sz.width - winSize0.width, sz.height - winSize0.height };
+
+            CvRect equRect = { icv_object_win_border, icv_object_win_border,
+                winSize0.width - icv_object_win_border*2,
+                winSize0.height - icv_object_win_border*2 };
+
             CvMat img1, sum1, sqsum1, norm1, tilted1, mask1;
             CvMat* _tilted = 0;
 
             if( sz1.width <= 0 || sz1.height <= 0 )
                 break;
-            if( win_size.width < min_size.width || win_size.height < min_size.height )
+            if( winSize.width < minSize.width || winSize.height < minSize.height )
                 continue;
 
-            img1 = cvMat( sz.height, sz.width, CV_8UC1, img_small->data.ptr );
+            img1 = cvMat( sz.height, sz.width, CV_8UC1, imgSmall->data.ptr );
             sum1 = cvMat( sz.height+1, sz.width+1, CV_32SC1, sum->data.ptr );
             sqsum1 = cvMat( sz.height+1, sz.width+1, CV_64FC1, sqsum->data.ptr );
             if( tilted )
@@ -1008,181 +1081,82 @@ cvHaarDetectObjects( const CvArr* _img,
                 tilted1 = cvMat( sz.height+1, sz.width+1, CV_32SC1, tilted->data.ptr );
                 _tilted = &tilted1;
             }
-            norm1 = cvMat( sz1.height, sz1.width, CV_32FC1, norm_img ? norm_img->data.ptr : 0 );
+            norm1 = cvMat( sz1.height, sz1.width, CV_32FC1, normImg ? normImg->data.ptr : 0 );
             mask1 = cvMat( sz1.height, sz1.width, CV_8UC1, temp->data.ptr );
 
             cvResize( img, &img1, CV_INTER_LINEAR );
             cvIntegral( &img1, &sum1, &sqsum1, _tilted );
 
-            if( max_threads > 1 )
-            {
-                strip_count = MAX(MIN(sz1.height/ystep, max_threads*3), 1);
-                strip_size = (sz1.height + strip_count - 1)/strip_count;
-                strip_size = (strip_size / ystep)*ystep;
-            }
-            else
-            {
-                strip_count = 1;
-                strip_size = sz1.height;
-            }
-
+            int ystep = factor > 2 ? 1 : 2;
+        #ifdef HAVE_TBB
+            const int LOCS_PER_THREAD = 1000;
+            int stripCount = ((sz1.width/ystep)*(sz1.height + ystep-1)/ystep + LOCS_PER_THREAD/2)/LOCS_PER_THREAD;
+            stripCount = std::min(std::max(stripCount, 1), 100);
+        #else
+            const int stripCount = 1;
+        #endif
+            
 #ifdef HAVE_IPP
             if( use_ipp )
             {
-                for( i = 0; i <= sz.height; i++ )
-                {
-                    const int* isum = (int*)(sum1.data.ptr + sum1.step*i);
-                    float* fsum = (float*)isum;
-                    const int FLT_DELTA = -(1 << 24);
-                    int j;
-                    for( j = 0; j <= sz.width; j++ )
-                        fsum[j] = (float)(isum[j] + FLT_DELTA);
-                }
+                cv::Mat fsum(sum1.rows, sum1.cols, CV_32F, sum1.data.ptr, sum1.step);
+                cv::Mat(&sum1).convertTo(fsum, CV_32F, 1, -(1<<24));
             }
             else
 #endif
-                cvSetImagesForHaarClassifierCascade( cascade, &sum1, &sqsum1, _tilted, 1. );
-
-        #ifdef _OPENMP
-            #pragma omp parallel for num_threads(max_threads) schedule(dynamic)
-        #endif
-            for( i = 0; i < strip_count; i++ )
-            {
-                int thread_id = cvGetThreadNum();
-                int positive = 0;
-                int y1 = i*strip_size, y2 = (i+1)*strip_size/* - ystep + 1*/;
-                CvSize ssz;
-                int x, y;
-                if( i == strip_count - 1 || y2 > sz1.height )
-                    y2 = sz1.height;
-                ssz = cvSize(sz1.width, y2 - y1);
-
-#ifdef HAVE_IPP
-                if( use_ipp )
-                {
-                    ippiRectStdDev_32f_C1R(
-                        (float*)(sum1.data.ptr + y1*sum1.step), sum1.step,
-                        (double*)(sqsum1.data.ptr + y1*sqsum1.step), sqsum1.step,
-                        (float*)(norm1.data.ptr + y1*norm1.step), norm1.step,
-                        ippiSize(ssz.width, ssz.height), equ_rect );
-
-                    positive = (ssz.width/ystep)*((ssz.height + ystep-1)/ystep);
-                    memset( mask1.data.ptr + y1*mask1.step, ystep == 1, mask1.height*mask1.step);
-                    
-                    if( ystep > 1 )
-                    {
-                        for( y = y1, positive = 0; y < y2; y += ystep )
-                            for( x = 0; x < ssz.width; x += ystep )
-                                mask1.data.ptr[mask1.step*y + x] = (uchar)1;
-                    }
-
-                    for( int j = 0; j < cascade->count; j++ )
-                    {
-                        if( ippiApplyHaarClassifier_32f_C1R(
-                            (float*)(sum1.data.ptr + y1*sum1.step), sum1.step,
-                            (float*)(norm1.data.ptr + y1*norm1.step), norm1.step,
-                            mask1.data.ptr + y1*mask1.step, mask1.step,
-                            ippiSize(ssz.width, ssz.height), &positive,
-                            cascade->hid_cascade->stage_classifier[j].threshold,
-                            (IppiHaarClassifier_32f*)cascade->hid_cascade->ipp_stages[j]) < 0 )
-                        {
-                            positive = 0;
-                            break;
-                        }
-                        if( positive <= 0 )
-                            break;
-                    }
-                }
-                else
-#endif
-                {
-                    for( y = y1, positive = 0; y < y2; y += ystep )
-                        for( x = 0; x < ssz.width; x += ystep )
-                        {
-                            mask1.data.ptr[mask1.step*y + x] =
-                                cvRunHaarClassifierCascade( cascade, cvPoint(x,y), 0 ) > 0;
-                            positive += mask1.data.ptr[mask1.step*y + x];
-                        }
-                }
-
-                if( positive > 0 )
-                {
-                    for( y = y1; y < y2; y += ystep )
-                        for( x = 0; x < ssz.width; x += ystep )
-                            if( mask1.data.ptr[mask1.step*y + x] != 0 )
-                            {
-                                CvRect obj_rect = { cvRound(x*factor), cvRound(y*factor),
-                                                    win_size.width, win_size.height };
-                                cvSeqPush( seq_thread[thread_id], &obj_rect );
-                            }
-                }
-            }
-
-            // gather the results
-            if( max_threads > 1 )
-                for( i = 0; i < max_threads; i++ )
-                {
-                    CvSeq* s = seq_thread[i];
-                    int j, total = s->total;
-                    CvSeqBlock* b = s->first;
-                    for( j = 0; j < total; j += b->count, b = b->next )
-                        cvSeqPushMulti( seq, b->data, b->count );
-                }
+                cvSetImagesForHaarClassifierCascade( cascade, &sum1, &sqsum1, _tilted, 1. );            
+            
+            cv::Mat _norm1(&norm1), _mask1(&mask1);
+            cv::parallel_for(cv::BlockedRange(0, stripCount),
+                         cv::HaarDetectObjects_ScaleImage_Invoker(cascade,
+                                (((sz1.height + stripCount - 1)/stripCount + ystep-1)/ystep)*ystep,
+                                factor, cv::Mat(&sum1), cv::Mat(&sqsum1), &_norm1, &_mask1,
+                                cv::Rect(equRect), allCandidates));
         }
     }
     else
     {
         int n_factors = 0;
-        CvRect scan_roi_rect = {0,0,0,0};
-        bool is_found = false, scan_roi = false;
+        cv::Rect scanROI;
 
         cvIntegral( img, sum, sqsum, tilted );
 
-        if( do_canny_pruning )
+        if( doCannyPruning )
         {
             sumcanny = cvCreateMat( img->rows + 1, img->cols + 1, CV_32SC1 );
             cvCanny( img, temp, 0, 50, 3 );
             cvIntegral( temp, sumcanny );
         }
 
-        if( (unsigned)split_stage >= (unsigned)cascade->count ||
-            cascade->hid_cascade->is_tree )
-        {
-            split_stage = cascade->count;
-            npass = 1;
-        }
-
         for( n_factors = 0, factor = 1;
              factor*cascade->orig_window_size.width < img->cols - 10 &&
              factor*cascade->orig_window_size.height < img->rows - 10;
-             n_factors++, factor *= scale_factor )
+             n_factors++, factor *= scaleFactor )
             ;
 
-        if( find_biggest_object )
+        if( findBiggestObject )
         {
-            scale_factor = 1./scale_factor;
-            factor *= scale_factor;
-            big_seq = cvCreateSeq( 0, sizeof(CvSeq), sizeof(CvRect), temp_storage );
+            scaleFactor = 1./scaleFactor;
+            factor *= scaleFactor;
         }
         else
             factor = 1;
 
-        for( ; n_factors-- > 0 && !is_found; factor *= scale_factor )
+        for( ; n_factors-- > 0; factor *= scaleFactor )
         {
-            const double ystep = MAX( 2, factor );
-            CvSize win_size = { cvRound( cascade->orig_window_size.width * factor ),
+            const double ystep = std::max( 2., factor );
+            CvSize winSize = { cvRound( cascade->orig_window_size.width * factor ),
                                 cvRound( cascade->orig_window_size.height * factor )};
-            CvRect equ_rect = { 0, 0, 0, 0 };
-            int *p0 = 0, *p1 = 0, *p2 = 0, *p3 = 0;
-            int *pq0 = 0, *pq1 = 0, *pq2 = 0, *pq3 = 0;
-            int pass, stage_offset = 0;
-            int start_x = 0, start_y = 0;
-            int end_x = cvRound((img->cols - win_size.width) / ystep);
-            int end_y = cvRound((img->rows - win_size.height) / ystep);
-
-            if( win_size.width < min_size.width || win_size.height < min_size.height )
+            CvRect equRect = { 0, 0, 0, 0 };
+            int *p[4] = {0,0,0,0};
+            int *pq[4] = {0,0,0,0};
+            int startX = 0, startY = 0;
+            int endX = cvRound((img->cols - winSize.width) / ystep);
+            int endY = cvRound((img->rows - winSize.height) / ystep);
+
+            if( winSize.width < minSize.width || winSize.height < minSize.height )
             {
-                if( find_biggest_object )
+                if( findBiggestObject )
                     break;
                 continue;
             }
@@ -1190,389 +1164,112 @@ cvHaarDetectObjects( const CvArr* _img,
             cvSetImagesForHaarClassifierCascade( cascade, sum, sqsum, tilted, factor );
             cvZero( temp );
 
-            if( do_canny_pruning )
+            if( doCannyPruning )
             {
-                equ_rect.x = cvRound(win_size.width*0.15);
-                equ_rect.y = cvRound(win_size.height*0.15);
-                equ_rect.width = cvRound(win_size.width*0.7);
-                equ_rect.height = cvRound(win_size.height*0.7);
-
-                p0 = (int*)(sumcanny->data.ptr + equ_rect.y*sumcanny->step) + equ_rect.x;
-                p1 = (int*)(sumcanny->data.ptr + equ_rect.y*sumcanny->step)
-                            + equ_rect.x + equ_rect.width;
-                p2 = (int*)(sumcanny->data.ptr + (equ_rect.y + equ_rect.height)*sumcanny->step) + equ_rect.x;
-                p3 = (int*)(sumcanny->data.ptr + (equ_rect.y + equ_rect.height)*sumcanny->step)
-                            + equ_rect.x + equ_rect.width;
-
-                pq0 = (int*)(sum->data.ptr + equ_rect.y*sum->step) + equ_rect.x;
-                pq1 = (int*)(sum->data.ptr + equ_rect.y*sum->step)
-                            + equ_rect.x + equ_rect.width;
-                pq2 = (int*)(sum->data.ptr + (equ_rect.y + equ_rect.height)*sum->step) + equ_rect.x;
-                pq3 = (int*)(sum->data.ptr + (equ_rect.y + equ_rect.height)*sum->step)
-                            + equ_rect.x + equ_rect.width;
+                equRect.x = cvRound(winSize.width*0.15);
+                equRect.y = cvRound(winSize.height*0.15);
+                equRect.width = cvRound(winSize.width*0.7);
+                equRect.height = cvRound(winSize.height*0.7);
+
+                p[0] = (int*)(sumcanny->data.ptr + equRect.y*sumcanny->step) + equRect.x;
+                p[1] = (int*)(sumcanny->data.ptr + equRect.y*sumcanny->step)
+                            + equRect.x + equRect.width;
+                p[2] = (int*)(sumcanny->data.ptr + (equRect.y + equRect.height)*sumcanny->step) + equRect.x;
+                p[3] = (int*)(sumcanny->data.ptr + (equRect.y + equRect.height)*sumcanny->step)
+                            + equRect.x + equRect.width;
+
+                pq[0] = (int*)(sum->data.ptr + equRect.y*sum->step) + equRect.x;
+                pq[1] = (int*)(sum->data.ptr + equRect.y*sum->step)
+                            + equRect.x + equRect.width;
+                pq[2] = (int*)(sum->data.ptr + (equRect.y + equRect.height)*sum->step) + equRect.x;
+                pq[3] = (int*)(sum->data.ptr + (equRect.y + equRect.height)*sum->step)
+                            + equRect.x + equRect.width;
             }
 
-            if( scan_roi )
+            if( scanROI.area() > 0 )
             {
                 //adjust start_height and stop_height
-                start_y = cvRound(scan_roi_rect.y / ystep);
-                end_y = cvRound((scan_roi_rect.y + scan_roi_rect.height - win_size.height) / ystep);
+                startY = cvRound(scanROI.y / ystep);
+                endY = cvRound((scanROI.y + scanROI.height - winSize.height) / ystep);
 
-                start_x = cvRound(scan_roi_rect.x / ystep);
-                end_x = cvRound((scan_roi_rect.x + scan_roi_rect.width - win_size.width) / ystep);
+                startX = cvRound(scanROI.x / ystep);
+                endX = cvRound((scanROI.x + scanROI.width - winSize.width) / ystep);
             }
 
-            cascade->hid_cascade->count = split_stage;
-
-            for( pass = 0; pass < npass; pass++ )
-            {
-            #ifdef _OPENMP
-                #pragma omp parallel for num_threads(max_threads) schedule(dynamic)
-            #endif
-                for( int _iy = start_y; _iy < end_y; _iy++ )
-                {
-                    int thread_id = cvGetThreadNum();
-                    int iy = cvRound(_iy*ystep);
-                    int _ix, _xstep = 1;
-                    uchar* mask_row = temp->data.ptr + temp->step * iy;
-
-                    for( _ix = start_x; _ix < end_x; _ix += _xstep )
-                    {
-                        int ix = cvRound(_ix*ystep); // it really should be ystep
-
-                        if( pass == 0 )
-                        {
-                            int result;
-                            _xstep = 2;
-
-                            if( do_canny_pruning )
-                            {
-                                int offset;
-                                int s, sq;
-
-                                offset = iy*(sum->step/sizeof(p0[0])) + ix;
-                                s = p0[offset] - p1[offset] - p2[offset] + p3[offset];
-                                sq = pq0[offset] - pq1[offset] - pq2[offset] + pq3[offset];
-                                if( s < 100 || sq < 20 )
-                                    continue;
-                            }
-
-                            result = cvRunHaarClassifierCascade( cascade, cvPoint(ix,iy), 0 );
-                            if( result > 0 )
-                            {
-                                if( pass < npass - 1 )
-                                    mask_row[ix] = 1;
-                                else
-                                {
-                                    CvRect rect = cvRect(ix,iy,win_size.width,win_size.height);
-                                    cvSeqPush( seq_thread[thread_id], &rect );
-                                }
-                            }
-                            if( result < 0 )
-                                _xstep = 1;
-                        }
-                        else if( mask_row[ix] )
-                        {
-                            int result = cvRunHaarClassifierCascade( cascade, cvPoint(ix,iy),
-                                                                     stage_offset );
-                            if( result > 0 )
-                            {
-                                if( pass == npass - 1 )
-                                {
-                                    CvRect rect = cvRect(ix,iy,win_size.width,win_size.height);
-                                    cvSeqPush( seq_thread[thread_id], &rect );
-                                }
-                            }
-                            else
-                                mask_row[ix] = 0;
-                        }
-                    }
-                }
-                stage_offset = cascade->hid_cascade->count;
-                cascade->hid_cascade->count = cascade->count;
-            }
+            cv::parallel_for(cv::BlockedRange(startY, endY),
+                cv::HaarDetectObjects_ScaleCascade_Invoker(cascade, winSize, cv::Range(startX, endX),
+                                                           ystep, sum->step, (const int**)p,
+                                                           (const int**)pq, allCandidates ));
 
-            // gather the results
-            if( max_threads > 1 )
-                   for( i = 0; i < max_threads; i++ )
-                   {
-                           CvSeq* s = seq_thread[i];
-                    int j, total = s->total;
-                    CvSeqBlock* b = s->first;
-                    for( j = 0; j < total; j += b->count, b = b->next )
-                        cvSeqPushMulti( seq, b->data, b->count );
-                   }
-
-            if( find_biggest_object )
+            if( findBiggestObject && !allCandidates.empty() && scanROI.area() == 0 )
             {
-                CvSeq* bseq = min_neighbors > 0 ? big_seq : seq;
+                rectList.resize(allCandidates.size());
+                std::copy(allCandidates.begin(), allCandidates.end(), rectList.begin());
                 
-                if( min_neighbors > 0 && !scan_roi )
-                {
-                    // group retrieved rectangles in order to filter out noise
-                    int ncomp = cvSeqPartition( seq, 0, &idx_seq, is_equal, 0 );
-                    CV_CALL( comps = (CvAvgComp*)cvAlloc( (ncomp+1)*sizeof(comps[0])));
-                    memset( comps, 0, (ncomp+1)*sizeof(comps[0]));
-
-                #if VERY_ROUGH_SEARCH
-                    if( rough_search )
-                    {
-                        for( i = 0; i < seq->total; i++ )
-                        {
-                            CvRect r1 = *(CvRect*)cvGetSeqElem( seq, i );
-                            int idx = *(int*)cvGetSeqElem( idx_seq, i );
-                            assert( (unsigned)idx < (unsigned)ncomp );
-
-                            comps[idx].neighbors++;
-                            comps[idx].rect.x += r1.x;
-                            comps[idx].rect.y += r1.y;
-                            comps[idx].rect.width += r1.width;
-                            comps[idx].rect.height += r1.height;
-                        }
-
-                        // calculate average bounding box
-                        for( i = 0; i < ncomp; i++ )
-                        {
-                            int n = comps[i].neighbors;
-                            if( n >= min_neighbors )
-                            {
-                                CvAvgComp comp;
-                                comp.rect.x = (comps[i].rect.x*2 + n)/(2*n);
-                                comp.rect.y = (comps[i].rect.y*2 + n)/(2*n);
-                                comp.rect.width = (comps[i].rect.width*2 + n)/(2*n);
-                                comp.rect.height = (comps[i].rect.height*2 + n)/(2*n);
-                                comp.neighbors = n;
-                                cvSeqPush( bseq, &comp );
-                            }
-                        }
-                    }
-                    else
-                #endif
-                    {
-                        for( i = 0 ; i <= ncomp; i++ )
-                            comps[i].rect.x = comps[i].rect.y = INT_MAX;
-
-                        // count number of neighbors
-                        for( i = 0; i < seq->total; i++ )
-                        {
-                            CvRect r1 = *(CvRect*)cvGetSeqElem( seq, i );
-                            int idx = *(int*)cvGetSeqElem( idx_seq, i );
-                            assert( (unsigned)idx < (unsigned)ncomp );
-
-                            comps[idx].neighbors++;
-
-                            // rect.width and rect.height will store coordinate of right-bottom corner
-                            comps[idx].rect.x = MIN(comps[idx].rect.x, r1.x);
-                            comps[idx].rect.y = MIN(comps[idx].rect.y, r1.y);
-                            comps[idx].rect.width = MAX(comps[idx].rect.width, r1.x+r1.width-1);
-                            comps[idx].rect.height = MAX(comps[idx].rect.height, r1.y+r1.height-1);
-                        }
-
-                        // calculate enclosing box
-                        for( i = 0; i < ncomp; i++ )
-                        {
-                            int n = comps[i].neighbors;
-                            if( n >= min_neighbors )
-                            {
-                                CvAvgComp comp;
-                                int t;
-                                double min_scale = rough_search ? 0.6 : 0.4;
-                                comp.rect.x = comps[i].rect.x;
-                                comp.rect.y = comps[i].rect.y;
-                                comp.rect.width = comps[i].rect.width - comps[i].rect.x + 1;
-                                comp.rect.height = comps[i].rect.height - comps[i].rect.y + 1;
-
-                                // update min_size
-                                t = cvRound( comp.rect.width*min_scale );
-                                min_size.width = MAX( min_size.width, t );
-
-                                t = cvRound( comp.rect.height*min_scale );
-                                min_size.height = MAX( min_size.height, t );
-
-                                //expand the box by 20% because we could miss some neighbours
-                                //see 'is_equal' function
-                            #if 1
-                                int offset = cvRound(comp.rect.width * 0.2);
-                                int right = MIN( img->cols-1, comp.rect.x+comp.rect.width-1 + offset );
-                                int bottom = MIN( img->rows-1, comp.rect.y+comp.rect.height-1 + offset);
-                                comp.rect.x = MAX( comp.rect.x - offset, 0 );
-                                comp.rect.y = MAX( comp.rect.y - offset, 0 );
-                                comp.rect.width = right - comp.rect.x + 1;
-                                comp.rect.height = bottom - comp.rect.y + 1;
-                            #endif
-
-                                comp.neighbors = n;
-                                cvSeqPush( bseq, &comp );
-                            }
-                        }
-                    }
-
-                    cvFree( &comps );
-                }
-
-                // extract the biggest rect
-                if( bseq->total > 0 )
+                groupRectangles(rectList, std::max(minNeighbors, 1), GROUP_EPS);
+                
+                if( !rectList.empty() )
                 {
-                    int max_area = 0;
-                    for( i = 0; i < bseq->total; i++ )
-                    {
-                        CvAvgComp* comp = (CvAvgComp*)cvGetSeqElem( bseq, i );
-                        int area = comp->rect.width * comp->rect.height;
-                        if( max_area < area )
-                        {
-                            max_area = area;
-                            result_comp.rect = comp->rect;
-                            result_comp.neighbors = bseq == seq ? 1 : comp->neighbors;
-                        }
-                    }
-
-                    //Prepare information for further scanning inside the biggest rectangle
-
-                #if VERY_ROUGH_SEARCH
-                    // change scan ranges to roi in case of required
-                    if( !rough_search && !scan_roi )
-                    {
-                        scan_roi = true;
-                        scan_roi_rect = result_comp.rect;
-                        cvClearSeq(bseq);
-                    }
-                    else if( rough_search )
-                        is_found = true;
-                #else
-                    if( !scan_roi )
+                    size_t i, sz = rectList.size();
+                    cv::Rect maxRect;
+                    
+                    for( i = 0; i < sz; i++ )
                     {
-                        scan_roi = true;
-                        scan_roi_rect = result_comp.rect;
-                        cvClearSeq(bseq);
+                        if( rectList[i].area() > maxRect.area() )
+                            maxRect = rectList[i];
                     }
-                #endif
+                    
+                    allCandidates.push_back(maxRect);
+                    
+                    scanROI = maxRect;
+                    int dx = cvRound(maxRect.width*GROUP_EPS);
+                    int dy = cvRound(maxRect.height*GROUP_EPS);
+                    scanROI.x = std::max(scanROI.x - dx, 0);
+                    scanROI.y = std::max(scanROI.y - dy, 0);
+                    scanROI.width = std::min(scanROI.width + dx*2, img->cols-1-scanROI.x);
+                    scanROI.height = std::min(scanROI.height + dy*2, img->rows-1-scanROI.y);
+                
+                    double minScale = roughSearch ? 0.6 : 0.4;
+                    minSize.width = cvRound(maxRect.width*minScale);
+                    minSize.height = cvRound(maxRect.height*minScale);
                 }
             }
         }
     }
 
-    if( min_neighbors == 0 && !find_biggest_object )
-    {
-        for( i = 0; i < seq->total; i++ )
-        {
-            CvRect* rect = (CvRect*)cvGetSeqElem( seq, i );
-            CvAvgComp comp;
-            comp.rect = *rect;
-            comp.neighbors = 1;
-            cvSeqPush( result_seq, &comp );
-        }
-    }
-
-    if( min_neighbors != 0
-#if VERY_ROUGH_SEARCH        
-        && (!find_biggest_object || !rough_search)
-#endif        
-        )
+    rectList.resize(allCandidates.size());
+    if(!allCandidates.empty())
+        std::copy(allCandidates.begin(), allCandidates.end(), rectList.begin());
+    
+    if( minNeighbors != 0 || findBiggestObject )
+        groupRectangles(rectList, rweights, std::max(minNeighbors, 1), GROUP_EPS);
+        
+    if( findBiggestObject && rectList.size() )
     {
-        // group retrieved rectangles in order to filter out noise
-        int ncomp = cvSeqPartition( seq, 0, &idx_seq, is_equal, 0 );
-        CV_CALL( comps = (CvAvgComp*)cvAlloc( (ncomp+1)*sizeof(comps[0])));
-        memset( comps, 0, (ncomp+1)*sizeof(comps[0]));
-
-        // count number of neighbors
-        for( i = 0; i < seq->total; i++ )
-        {
-            CvRect r1 = *(CvRect*)cvGetSeqElem( seq, i );
-            int idx = *(int*)cvGetSeqElem( idx_seq, i );
-            assert( (unsigned)idx < (unsigned)ncomp );
-
-            comps[idx].neighbors++;
-
-            comps[idx].rect.x += r1.x;
-            comps[idx].rect.y += r1.y;
-            comps[idx].rect.width += r1.width;
-            comps[idx].rect.height += r1.height;
-        }
-
-        // calculate average bounding box
-        for( i = 0; i < ncomp; i++ )
-        {
-            int n = comps[i].neighbors;
-            if( n >= min_neighbors )
-            {
-                CvAvgComp comp;
-                comp.rect.x = (comps[i].rect.x*2 + n)/(2*n);
-                comp.rect.y = (comps[i].rect.y*2 + n)/(2*n);
-                comp.rect.width = (comps[i].rect.width*2 + n)/(2*n);
-                comp.rect.height = (comps[i].rect.height*2 + n)/(2*n);
-                comp.neighbors = comps[i].neighbors;
-
-                cvSeqPush( seq2, &comp );
-            }
-        }
-
-        if( !find_biggest_object )
+        CvAvgComp result_comp = {{0,0,0,0},0};
+        
+        for( size_t i = 0; i < rectList.size(); i++ )
         {
-            // filter out small face rectangles inside large face rectangles
-            for( i = 0; i < seq2->total; i++ )
+            cv::Rect r = rectList[i];
+            if( r.area() > cv::Rect(result_comp.rect).area() )
             {
-                CvAvgComp r1 = *(CvAvgComp*)cvGetSeqElem( seq2, i );
-                int j, flag = 1;
-
-                for( j = 0; j < seq2->total; j++ )
-                {
-                    CvAvgComp r2 = *(CvAvgComp*)cvGetSeqElem( seq2, j );
-                    int distance = cvRound( r2.rect.width * 0.2 );
-
-                    if( i != j &&
-                        r1.rect.x >= r2.rect.x - distance &&
-                        r1.rect.y >= r2.rect.y - distance &&
-                        r1.rect.x + r1.rect.width <= r2.rect.x + r2.rect.width + distance &&
-                        r1.rect.y + r1.rect.height <= r2.rect.y + r2.rect.height + distance &&
-                        (r2.neighbors > MAX( 3, r1.neighbors ) || r1.neighbors < 3) )
-                    {
-                        flag = 0;
-                        break;
-                    }
-                }
-
-                if( flag )
-                    cvSeqPush( result_seq, &r1 );
+                result_comp.rect = r;
+                result_comp.neighbors = rweights[i];
             }
         }
-        else
+        cvSeqPush( result_seq, &result_comp );
+    }
+    else
+    {
+        for( size_t i = 0; i < rectList.size(); i++ )
         {
-            int max_area = 0;
-            for( i = 0; i < seq2->total; i++ )
-            {
-                CvAvgComp* comp = (CvAvgComp*)cvGetSeqElem( seq2, i );
-                int area = comp->rect.width * comp->rect.height;
-                if( max_area < area )
-                {
-                    max_area = area;
-                    result_comp = *comp;
-                }                
-            }
+            CvAvgComp c;
+            c.rect = rectList[i];
+            c.neighbors = rweights[i];
+            cvSeqPush( result_seq, &c );
         }
     }
 
-    if( find_biggest_object && result_comp.rect.width > 0 )
-        cvSeqPush( result_seq, &result_comp );
-
-    __END__;
-
-    if( max_threads > 1 )
-           for( i = 0; i < max_threads; i++ )
-           {
-                   if( seq_thread[i] )
-                cvReleaseMemStorage( &seq_thread[i]->storage );
-           }
-
-    cvReleaseMemStorage( &temp_storage );
-    cvReleaseMat( &sum );
-    cvReleaseMat( &sqsum );
-    cvReleaseMat( &tilted );
-    cvReleaseMat( &temp );
-    cvReleaseMat( &sumcanny );
-    cvReleaseMat( &norm_img );
-    cvReleaseMat( &img_small );
-    cvFree( &comps );
-
     return result_seq;
 }
 
@@ -1699,10 +1396,6 @@ cvLoadHaarClassifierCascade( const char* directory, CvSize orig_window_size )
     const char** input_cascade = 0;
     CvHaarClassifierCascade *cascade = 0;
 
-    CV_FUNCNAME( "cvLoadHaarClassifierCascade" );
-
-    __BEGIN__;
-
     int i, n;
     const char* slash;
     char name[_MAX_PATH];
@@ -1710,7 +1403,7 @@ cvLoadHaarClassifierCascade( const char* directory, CvSize orig_window_size )
     char* ptr = 0;
 
     if( !directory )
-        CV_ERROR( CV_StsNullPtr, "Null path is passed" );
+        CV_Error( CV_StsNullPtr, "Null path is passed" );
 
     n = (int)strlen(directory)-1;
     slash = directory[n] == '\\' || directory[n] == '/' ? "" : "/";
@@ -1728,15 +1421,13 @@ cvLoadHaarClassifierCascade( const char* directory, CvSize orig_window_size )
     }
 
     if( n == 0 && slash[0] )
-    {
-        CV_CALL( cascade = (CvHaarClassifierCascade*)cvLoad( directory ));
-        EXIT;
-    }
-    else if( n == 0 )
-        CV_ERROR( CV_StsBadArg, "Invalid path" );
+        return (CvHaarClassifierCascade*)cvLoad( directory );
+
+    if( n == 0 )
+        CV_Error( CV_StsBadArg, "Invalid path" );
 
     size += (n+1)*sizeof(char*);
-    CV_CALL( input_cascade = (const char**)cvAlloc( size ));
+    input_cascade = (const char**)cvAlloc( size );
     ptr = (char*)(input_cascade + n + 1);
 
     for( i = 0; i < n; i++ )
@@ -1744,7 +1435,7 @@ cvLoadHaarClassifierCascade( const char* directory, CvSize orig_window_size )
         sprintf( name, "%s/%d/AdaBoostCARTHaarClassifier.txt", directory, i );
         FILE* f = fopen( name, "rb" );
         if( !f )
-            CV_ERROR( CV_StsError, "" );
+            CV_Error( CV_StsError, "" );
         fseek( f, 0, SEEK_END );
         size = ftell( f );
         fseek( f, 0, SEEK_SET );
@@ -1758,14 +1449,9 @@ cvLoadHaarClassifierCascade( const char* directory, CvSize orig_window_size )
     input_cascade[n] = 0;
     cascade = icvLoadCascadeCART( input_cascade, n, orig_window_size );
 
-    __END__;
-
     if( input_cascade )
         cvFree( &input_cascade );
 
-    if( cvGetErrStatus() < 0 )
-        cvReleaseHaarClassifierCascade( &cascade );
-
     return cascade;
 }
 
@@ -1822,10 +1508,6 @@ icvReadHaarClassifier( CvFileStorage* fs, CvFileNode* node )
 {
     CvHaarClassifierCascade* cascade = NULL;
 
-    CV_FUNCNAME( "cvReadHaarClassifier" );
-
-    __BEGIN__;
-
     char buf[256];
     CvFileNode* seq_fn = NULL; /* sequence */
     CvFileNode* fn = NULL;
@@ -1835,27 +1517,27 @@ icvReadHaarClassifier( CvFileStorage* fs, CvFileNode* node )
     int i, j, k, l;
     int parent, next;
 
-    CV_CALL( stages_fn = cvGetFileNodeByName( fs, node, ICV_HAAR_STAGES_NAME ) );
+    stages_fn = cvGetFileNodeByName( fs, node, ICV_HAAR_STAGES_NAME );
     if( !stages_fn || !CV_NODE_IS_SEQ( stages_fn->tag) )
-        CV_ERROR( CV_StsError, "Invalid stages node" );
+        CV_Error( CV_StsError, "Invalid stages node" );
 
     n = stages_fn->data.seq->total;
-    CV_CALL( cascade = icvCreateHaarClassifierCascade(n) );
+    cascade = icvCreateHaarClassifierCascade(n);
 
     /* read size */
-    CV_CALL( seq_fn = cvGetFileNodeByName( fs, node, ICV_HAAR_SIZE_NAME ) );
+    seq_fn = cvGetFileNodeByName( fs, node, ICV_HAAR_SIZE_NAME );
     if( !seq_fn || !CV_NODE_IS_SEQ( seq_fn->tag ) || seq_fn->data.seq->total != 2 )
-        CV_ERROR( CV_StsError, "size node is not a valid sequence." );
-    CV_CALL( fn = (CvFileNode*) cvGetSeqElem( seq_fn->data.seq, 0 ) );
+        CV_Error( CV_StsError, "size node is not a valid sequence." );
+    fn = (CvFileNode*) cvGetSeqElem( seq_fn->data.seq, 0 );
     if( !CV_NODE_IS_INT( fn->tag ) || fn->data.i <= 0 )
-        CV_ERROR( CV_StsError, "Invalid size node: width must be positive integer" );
+        CV_Error( CV_StsError, "Invalid size node: width must be positive integer" );
     cascade->orig_window_size.width = fn->data.i;
-    CV_CALL( fn = (CvFileNode*) cvGetSeqElem( seq_fn->data.seq, 1 ) );
+    fn = (CvFileNode*) cvGetSeqElem( seq_fn->data.seq, 1 );
     if( !CV_NODE_IS_INT( fn->tag ) || fn->data.i <= 0 )
-        CV_ERROR( CV_StsError, "Invalid size node: height must be positive integer" );
+        CV_Error( CV_StsError, "Invalid size node: height must be positive integer" );
     cascade->orig_window_size.height = fn->data.i;
 
-    CV_CALL( cvStartReadSeq( stages_fn->data.seq, &stages_reader ) );
+    cvStartReadSeq( stages_fn->data.seq, &stages_reader );
     for( i = 0; i < n; ++i )
     {
         CvFileNode* stage_fn;
@@ -1866,27 +1548,27 @@ icvReadHaarClassifier( CvFileStorage* fs, CvFileNode* node )
         if( !CV_NODE_IS_MAP( stage_fn->tag ) )
         {
             sprintf( buf, "Invalid stage %d", i );
-            CV_ERROR( CV_StsError, buf );
+            CV_Error( CV_StsError, buf );
         }
 
-        CV_CALL( trees_fn = cvGetFileNodeByName( fs, stage_fn, ICV_HAAR_TREES_NAME ) );
+        trees_fn = cvGetFileNodeByName( fs, stage_fn, ICV_HAAR_TREES_NAME );
         if( !trees_fn || !CV_NODE_IS_SEQ( trees_fn->tag )
             || trees_fn->data.seq->total <= 0 )
         {
             sprintf( buf, "Trees node is not a valid sequence. (stage %d)", i );
-            CV_ERROR( CV_StsError, buf );
+            CV_Error( CV_StsError, buf );
         }
 
-        CV_CALL( cascade->stage_classifier[i].classifier =
+        cascade->stage_classifier[i].classifier =
             (CvHaarClassifier*) cvAlloc( trees_fn->data.seq->total
-                * sizeof( cascade->stage_classifier[i].classifier[0] ) ) );
+                * sizeof( cascade->stage_classifier[i].classifier[0] ) );
         for( j = 0; j < trees_fn->data.seq->total; ++j )
         {
             cascade->stage_classifier[i].classifier[j].haar_feature = NULL;
         }
         cascade->stage_classifier[i].count = trees_fn->data.seq->total;
 
-        CV_CALL( cvStartReadSeq( trees_fn->data.seq, &trees_reader ) );
+        cvStartReadSeq( trees_fn->data.seq, &trees_reader );
         for( j = 0; j < trees_fn->data.seq->total; ++j )
         {
             CvFileNode* tree_fn;
@@ -1900,22 +1582,22 @@ icvReadHaarClassifier( CvFileStorage* fs, CvFileNode* node )
             {
                 sprintf( buf, "Tree node is not a valid sequence."
                          " (stage %d, tree %d)", i, j );
-                CV_ERROR( CV_StsError, buf );
+                CV_Error( CV_StsError, buf );
             }
 
             classifier->count = tree_fn->data.seq->total;
-            CV_CALL( classifier->haar_feature = (CvHaarFeature*) cvAlloc(
+            classifier->haar_feature = (CvHaarFeature*) cvAlloc(
                 classifier->count * ( sizeof( *classifier->haar_feature ) +
                                       sizeof( *classifier->threshold ) +
                                       sizeof( *classifier->left ) +
                                       sizeof( *classifier->right ) ) +
-                (classifier->count + 1) * sizeof( *classifier->alpha ) ) );
+                (classifier->count + 1) * sizeof( *classifier->alpha ) );
             classifier->threshold = (float*) (classifier->haar_feature+classifier->count);
             classifier->left = (int*) (classifier->threshold + classifier->count);
             classifier->right = (int*) (classifier->left + classifier->count);
             classifier->alpha = (float*) (classifier->right + classifier->count);
 
-            CV_CALL( cvStartReadSeq( tree_fn->data.seq, &tree_reader ) );
+            cvStartReadSeq( tree_fn->data.seq, &tree_reader );
             for( k = 0, last_idx = 0; k < tree_fn->data.seq->total; ++k )
             {
                 CvFileNode* node_fn;
@@ -1928,27 +1610,25 @@ icvReadHaarClassifier( CvFileStorage* fs, CvFileNode* node )
                 {
                     sprintf( buf, "Tree node %d is not a valid map. (stage %d, tree %d)",
                              k, i, j );
-                    CV_ERROR( CV_StsError, buf );
+                    CV_Error( CV_StsError, buf );
                 }
-                CV_CALL( feature_fn = cvGetFileNodeByName( fs, node_fn,
-                    ICV_HAAR_FEATURE_NAME ) );
+                feature_fn = cvGetFileNodeByName( fs, node_fn, ICV_HAAR_FEATURE_NAME );
                 if( !feature_fn || !CV_NODE_IS_MAP( feature_fn->tag ) )
                 {
                     sprintf( buf, "Feature node is not a valid map. "
                              "(stage %d, tree %d, node %d)", i, j, k );
-                    CV_ERROR( CV_StsError, buf );
+                    CV_Error( CV_StsError, buf );
                 }
-                CV_CALL( rects_fn = cvGetFileNodeByName( fs, feature_fn,
-                    ICV_HAAR_RECTS_NAME ) );
+                rects_fn = cvGetFileNodeByName( fs, feature_fn, ICV_HAAR_RECTS_NAME );
                 if( !rects_fn || !CV_NODE_IS_SEQ( rects_fn->tag )
                     || rects_fn->data.seq->total < 1
                     || rects_fn->data.seq->total > CV_HAAR_FEATURE_MAX )
                 {
                     sprintf( buf, "Rects node is not a valid sequence. "
                              "(stage %d, tree %d, node %d)", i, j, k );
-                    CV_ERROR( CV_StsError, buf );
+                    CV_Error( CV_StsError, buf );
                 }
-                CV_CALL( cvStartReadSeq( rects_fn->data.seq, &rects_reader ) );
+                cvStartReadSeq( rects_fn->data.seq, &rects_reader );
                 for( l = 0; l < rects_fn->data.seq->total; ++l )
                 {
                     CvFileNode* rect_fn;
@@ -1959,7 +1639,7 @@ icvReadHaarClassifier( CvFileStorage* fs, CvFileNode* node )
                     {
                         sprintf( buf, "Rect %d is not a valid sequence. "
                                  "(stage %d, tree %d, node %d)", l, i, j, k );
-                        CV_ERROR( CV_StsError, buf );
+                        CV_Error( CV_StsError, buf );
                     }
 
                     fn = CV_SEQ_ELEM( rect_fn->data.seq, CvFileNode, 0 );
@@ -1967,7 +1647,7 @@ icvReadHaarClassifier( CvFileStorage* fs, CvFileNode* node )
                     {
                         sprintf( buf, "x coordinate must be non-negative integer. "
                                  "(stage %d, tree %d, node %d, rect %d)", i, j, k, l );
-                        CV_ERROR( CV_StsError, buf );
+                        CV_Error( CV_StsError, buf );
                     }
                     r.x = fn->data.i;
                     fn = CV_SEQ_ELEM( rect_fn->data.seq, CvFileNode, 1 );
@@ -1975,7 +1655,7 @@ icvReadHaarClassifier( CvFileStorage* fs, CvFileNode* node )
                     {
                         sprintf( buf, "y coordinate must be non-negative integer. "
                                  "(stage %d, tree %d, node %d, rect %d)", i, j, k, l );
-                        CV_ERROR( CV_StsError, buf );
+                        CV_Error( CV_StsError, buf );
                     }
                     r.y = fn->data.i;
                     fn = CV_SEQ_ELEM( rect_fn->data.seq, CvFileNode, 2 );
@@ -1985,7 +1665,7 @@ icvReadHaarClassifier( CvFileStorage* fs, CvFileNode* node )
                         sprintf( buf, "width must be positive integer and "
                                  "(x + width) must not exceed window width. "
                                  "(stage %d, tree %d, node %d, rect %d)", i, j, k, l );
-                        CV_ERROR( CV_StsError, buf );
+                        CV_Error( CV_StsError, buf );
                     }
                     r.width = fn->data.i;
                     fn = CV_SEQ_ELEM( rect_fn->data.seq, CvFileNode, 3 );
@@ -1995,7 +1675,7 @@ icvReadHaarClassifier( CvFileStorage* fs, CvFileNode* node )
                         sprintf( buf, "height must be positive integer and "
                                  "(y + height) must not exceed window height. "
                                  "(stage %d, tree %d, node %d, rect %d)", i, j, k, l );
-                        CV_ERROR( CV_StsError, buf );
+                        CV_Error( CV_StsError, buf );
                     }
                     r.height = fn->data.i;
                     fn = CV_SEQ_ELEM( rect_fn->data.seq, CvFileNode, 4 );
@@ -2003,7 +1683,7 @@ icvReadHaarClassifier( CvFileStorage* fs, CvFileNode* node )
                     {
                         sprintf( buf, "weight must be real number. "
                                  "(stage %d, tree %d, node %d, rect %d)", i, j, k, l );
-                        CV_ERROR( CV_StsError, buf );
+                        CV_Error( CV_StsError, buf );
                     }
 
                     classifier->haar_feature[k].rect[l].weight = (float) fn->data.f;
@@ -2017,23 +1697,23 @@ icvReadHaarClassifier( CvFileStorage* fs, CvFileNode* node )
                     classifier->haar_feature[k].rect[l].r = cvRect( 0, 0, 0, 0 );
                 }
 
-                CV_CALL( fn = cvGetFileNodeByName( fs, feature_fn, ICV_HAAR_TILTED_NAME));
+                fn = cvGetFileNodeByName( fs, feature_fn, ICV_HAAR_TILTED_NAME);
                 if( !fn || !CV_NODE_IS_INT( fn->tag ) )
                 {
                     sprintf( buf, "tilted must be 0 or 1. "
                              "(stage %d, tree %d, node %d)", i, j, k );
-                    CV_ERROR( CV_StsError, buf );
+                    CV_Error( CV_StsError, buf );
                 }
                 classifier->haar_feature[k].tilted = ( fn->data.i != 0 );
-                CV_CALL( fn = cvGetFileNodeByName( fs, node_fn, ICV_HAAR_THRESHOLD_NAME));
+                fn = cvGetFileNodeByName( fs, node_fn, ICV_HAAR_THRESHOLD_NAME);
                 if( !fn || !CV_NODE_IS_REAL( fn->tag ) )
                 {
                     sprintf( buf, "threshold must be real number. "
                              "(stage %d, tree %d, node %d)", i, j, k );
-                    CV_ERROR( CV_StsError, buf );
+                    CV_Error( CV_StsError, buf );
                 }
                 classifier->threshold[k] = (float) fn->data.f;
-                CV_CALL( fn = cvGetFileNodeByName( fs, node_fn, ICV_HAAR_LEFT_NODE_NAME));
+                fn = cvGetFileNodeByName( fs, node_fn, ICV_HAAR_LEFT_NODE_NAME);
                 if( fn )
                 {
                     if( !CV_NODE_IS_INT( fn->tag ) || fn->data.i <= k
@@ -2041,38 +1721,37 @@ icvReadHaarClassifier( CvFileStorage* fs, CvFileNode* node )
                     {
                         sprintf( buf, "left node must be valid node number. "
                                  "(stage %d, tree %d, node %d)", i, j, k );
-                        CV_ERROR( CV_StsError, buf );
+                        CV_Error( CV_StsError, buf );
                     }
                     /* left node */
                     classifier->left[k] = fn->data.i;
                 }
                 else
                 {
-                    CV_CALL( fn = cvGetFileNodeByName( fs, node_fn,
-                        ICV_HAAR_LEFT_VAL_NAME ) );
+                    fn = cvGetFileNodeByName( fs, node_fn, ICV_HAAR_LEFT_VAL_NAME );
                     if( !fn )
                     {
                         sprintf( buf, "left node or left value must be specified. "
                                  "(stage %d, tree %d, node %d)", i, j, k );
-                        CV_ERROR( CV_StsError, buf );
+                        CV_Error( CV_StsError, buf );
                     }
                     if( !CV_NODE_IS_REAL( fn->tag ) )
                     {
                         sprintf( buf, "left value must be real number. "
                                  "(stage %d, tree %d, node %d)", i, j, k );
-                        CV_ERROR( CV_StsError, buf );
+                        CV_Error( CV_StsError, buf );
                     }
                     /* left value */
                     if( last_idx >= classifier->count + 1 )
                     {
                         sprintf( buf, "Tree structure is broken: too many values. "
                                  "(stage %d, tree %d, node %d)", i, j, k );
-                        CV_ERROR( CV_StsError, buf );
+                        CV_Error( CV_StsError, buf );
                     }
                     classifier->left[k] = -last_idx;
                     classifier->alpha[last_idx++] = (float) fn->data.f;
                 }
-                CV_CALL( fn = cvGetFileNodeByName( fs, node_fn,ICV_HAAR_RIGHT_NODE_NAME));
+                fn = cvGetFileNodeByName( fs, node_fn,ICV_HAAR_RIGHT_NODE_NAME);
                 if( fn )
                 {
                     if( !CV_NODE_IS_INT( fn->tag ) || fn->data.i <= k
@@ -2080,33 +1759,32 @@ icvReadHaarClassifier( CvFileStorage* fs, CvFileNode* node )
                     {
                         sprintf( buf, "right node must be valid node number. "
                                  "(stage %d, tree %d, node %d)", i, j, k );
-                        CV_ERROR( CV_StsError, buf );
+                        CV_Error( CV_StsError, buf );
                     }
                     /* right node */
                     classifier->right[k] = fn->data.i;
                 }
                 else
                 {
-                    CV_CALL( fn = cvGetFileNodeByName( fs, node_fn,
-                        ICV_HAAR_RIGHT_VAL_NAME ) );
+                    fn = cvGetFileNodeByName( fs, node_fn, ICV_HAAR_RIGHT_VAL_NAME );
                     if( !fn )
                     {
                         sprintf( buf, "right node or right value must be specified. "
                                  "(stage %d, tree %d, node %d)", i, j, k );
-                        CV_ERROR( CV_StsError, buf );
+                        CV_Error( CV_StsError, buf );
                     }
                     if( !CV_NODE_IS_REAL( fn->tag ) )
                     {
                         sprintf( buf, "right value must be real number. "
                                  "(stage %d, tree %d, node %d)", i, j, k );
-                        CV_ERROR( CV_StsError, buf );
+                        CV_Error( CV_StsError, buf );
                     }
                     /* right value */
                     if( last_idx >= classifier->count + 1 )
                     {
                         sprintf( buf, "Tree structure is broken: too many values. "
                                  "(stage %d, tree %d, node %d)", i, j, k );
-                        CV_ERROR( CV_StsError, buf );
+                        CV_Error( CV_StsError, buf );
                     }
                     classifier->right[k] = -last_idx;
                     classifier->alpha[last_idx++] = (float) fn->data.f;
@@ -2118,37 +1796,37 @@ icvReadHaarClassifier( CvFileStorage* fs, CvFileNode* node )
             {
                 sprintf( buf, "Tree structure is broken: too few values. "
                          "(stage %d, tree %d)", i, j );
-                CV_ERROR( CV_StsError, buf );
+                CV_Error( CV_StsError, buf );
             }
 
             CV_NEXT_SEQ_ELEM( sizeof( *tree_fn ), trees_reader );
         } /* for each tree */
 
-        CV_CALL( fn = cvGetFileNodeByName( fs, stage_fn, ICV_HAAR_STAGE_THRESHOLD_NAME));
+        fn = cvGetFileNodeByName( fs, stage_fn, ICV_HAAR_STAGE_THRESHOLD_NAME);
         if( !fn || !CV_NODE_IS_REAL( fn->tag ) )
         {
             sprintf( buf, "stage threshold must be real number. (stage %d)", i );
-            CV_ERROR( CV_StsError, buf );
+            CV_Error( CV_StsError, buf );
         }
         cascade->stage_classifier[i].threshold = (float) fn->data.f;
 
         parent = i - 1;
         next = -1;
 
-        CV_CALL( fn = cvGetFileNodeByName( fs, stage_fn, ICV_HAAR_PARENT_NAME ) );
+        fn = cvGetFileNodeByName( fs, stage_fn, ICV_HAAR_PARENT_NAME );
         if( !fn || !CV_NODE_IS_INT( fn->tag )
             || fn->data.i < -1 || fn->data.i >= cascade->count )
         {
             sprintf( buf, "parent must be integer number. (stage %d)", i );
-            CV_ERROR( CV_StsError, buf );
+            CV_Error( CV_StsError, buf );
         }
         parent = fn->data.i;
-        CV_CALL( fn = cvGetFileNodeByName( fs, stage_fn, ICV_HAAR_NEXT_NAME ) );
+        fn = cvGetFileNodeByName( fs, stage_fn, ICV_HAAR_NEXT_NAME );
         if( !fn || !CV_NODE_IS_INT( fn->tag )
             || fn->data.i < -1 || fn->data.i >= cascade->count )
         {
             sprintf( buf, "next must be integer number. (stage %d)", i );
-            CV_ERROR( CV_StsError, buf );
+            CV_Error( CV_StsError, buf );
         }
         next = fn->data.i;
 
@@ -2164,14 +1842,6 @@ icvReadHaarClassifier( CvFileStorage* fs, CvFileNode* node )
         CV_NEXT_SEQ_ELEM( sizeof( *stage_fn ), stages_reader );
     } /* for each stage */
 
-    __END__;
-
-    if( cvGetErrStatus() < 0 )
-    {
-        cvReleaseHaarClassifierCascade( &cascade );
-        cascade = NULL;
-    }
-
     return cascade;
 }
 
@@ -2179,45 +1849,41 @@ static void
 icvWriteHaarClassifier( CvFileStorage* fs, const char* name, const void* struct_ptr,
                         CvAttrList attributes )
 {
-    CV_FUNCNAME( "cvWriteHaarClassifier" );
-
-    __BEGIN__;
-
     int i, j, k, l;
     char buf[256];
     const CvHaarClassifierCascade* cascade = (const CvHaarClassifierCascade*) struct_ptr;
 
     /* TODO: parameters check */
 
-    CV_CALL( cvStartWriteStruct( fs, name, CV_NODE_MAP, CV_TYPE_NAME_HAAR, attributes ) );
+    cvStartWriteStruct( fs, name, CV_NODE_MAP, CV_TYPE_NAME_HAAR, attributes );
 
-    CV_CALL( cvStartWriteStruct( fs, ICV_HAAR_SIZE_NAME, CV_NODE_SEQ | CV_NODE_FLOW ) );
-    CV_CALL( cvWriteInt( fs, NULL, cascade->orig_window_size.width ) );
-    CV_CALL( cvWriteInt( fs, NULL, cascade->orig_window_size.height ) );
-    CV_CALL( cvEndWriteStruct( fs ) ); /* size */
+    cvStartWriteStruct( fs, ICV_HAAR_SIZE_NAME, CV_NODE_SEQ | CV_NODE_FLOW );
+    cvWriteInt( fs, NULL, cascade->orig_window_size.width );
+    cvWriteInt( fs, NULL, cascade->orig_window_size.height );
+    cvEndWriteStruct( fs ); /* size */
 
-    CV_CALL( cvStartWriteStruct( fs, ICV_HAAR_STAGES_NAME, CV_NODE_SEQ ) );
+    cvStartWriteStruct( fs, ICV_HAAR_STAGES_NAME, CV_NODE_SEQ );
     for( i = 0; i < cascade->count; ++i )
     {
-        CV_CALL( cvStartWriteStruct( fs, NULL, CV_NODE_MAP ) );
+        cvStartWriteStruct( fs, NULL, CV_NODE_MAP );
         sprintf( buf, "stage %d", i );
-        CV_CALL( cvWriteComment( fs, buf, 1 ) );
+        cvWriteComment( fs, buf, 1 );
 
-        CV_CALL( cvStartWriteStruct( fs, ICV_HAAR_TREES_NAME, CV_NODE_SEQ ) );
+        cvStartWriteStruct( fs, ICV_HAAR_TREES_NAME, CV_NODE_SEQ );
 
         for( j = 0; j < cascade->stage_classifier[i].count; ++j )
         {
             CvHaarClassifier* tree = &cascade->stage_classifier[i].classifier[j];
 
-            CV_CALL( cvStartWriteStruct( fs, NULL, CV_NODE_SEQ ) );
+            cvStartWriteStruct( fs, NULL, CV_NODE_SEQ );
             sprintf( buf, "tree %d", j );
-            CV_CALL( cvWriteComment( fs, buf, 1 ) );
+            cvWriteComment( fs, buf, 1 );
 
             for( k = 0; k < tree->count; ++k )
             {
                 CvHaarFeature* feature = &tree->haar_feature[k];
 
-                CV_CALL( cvStartWriteStruct( fs, NULL, CV_NODE_MAP ) );
+                cvStartWriteStruct( fs, NULL, CV_NODE_MAP );
                 if( k )
                 {
                     sprintf( buf, "node %d", k );
@@ -2226,70 +1892,64 @@ icvWriteHaarClassifier( CvFileStorage* fs, const char* name, const void* struct_
                 {
                     sprintf( buf, "root node" );
                 }
-                CV_CALL( cvWriteComment( fs, buf, 1 ) );
+                cvWriteComment( fs, buf, 1 );
 
-                CV_CALL( cvStartWriteStruct( fs, ICV_HAAR_FEATURE_NAME, CV_NODE_MAP ) );
+                cvStartWriteStruct( fs, ICV_HAAR_FEATURE_NAME, CV_NODE_MAP );
 
-                CV_CALL( cvStartWriteStruct( fs, ICV_HAAR_RECTS_NAME, CV_NODE_SEQ ) );
+                cvStartWriteStruct( fs, ICV_HAAR_RECTS_NAME, CV_NODE_SEQ );
                 for( l = 0; l < CV_HAAR_FEATURE_MAX && feature->rect[l].r.width != 0; ++l )
                 {
-                    CV_CALL( cvStartWriteStruct( fs, NULL, CV_NODE_SEQ | CV_NODE_FLOW ) );
-                    CV_CALL( cvWriteInt(  fs, NULL, feature->rect[l].r.x ) );
-                    CV_CALL( cvWriteInt(  fs, NULL, feature->rect[l].r.y ) );
-                    CV_CALL( cvWriteInt(  fs, NULL, feature->rect[l].r.width ) );
-                    CV_CALL( cvWriteInt(  fs, NULL, feature->rect[l].r.height ) );
-                    CV_CALL( cvWriteReal( fs, NULL, feature->rect[l].weight ) );
-                    CV_CALL( cvEndWriteStruct( fs ) ); /* rect */
+                    cvStartWriteStruct( fs, NULL, CV_NODE_SEQ | CV_NODE_FLOW );
+                    cvWriteInt(  fs, NULL, feature->rect[l].r.x );
+                    cvWriteInt(  fs, NULL, feature->rect[l].r.y );
+                    cvWriteInt(  fs, NULL, feature->rect[l].r.width );
+                    cvWriteInt(  fs, NULL, feature->rect[l].r.height );
+                    cvWriteReal( fs, NULL, feature->rect[l].weight );
+                    cvEndWriteStruct( fs ); /* rect */
                 }
-                CV_CALL( cvEndWriteStruct( fs ) ); /* rects */
-                CV_CALL( cvWriteInt( fs, ICV_HAAR_TILTED_NAME, feature->tilted ) );
-                CV_CALL( cvEndWriteStruct( fs ) ); /* feature */
+                cvEndWriteStruct( fs ); /* rects */
+                cvWriteInt( fs, ICV_HAAR_TILTED_NAME, feature->tilted );
+                cvEndWriteStruct( fs ); /* feature */
 
-                CV_CALL( cvWriteReal( fs, ICV_HAAR_THRESHOLD_NAME, tree->threshold[k]) );
+                cvWriteReal( fs, ICV_HAAR_THRESHOLD_NAME, tree->threshold[k]);
 
                 if( tree->left[k] > 0 )
                 {
-                    CV_CALL( cvWriteInt( fs, ICV_HAAR_LEFT_NODE_NAME, tree->left[k] ) );
+                    cvWriteInt( fs, ICV_HAAR_LEFT_NODE_NAME, tree->left[k] );
                 }
                 else
                 {
-                    CV_CALL( cvWriteReal( fs, ICV_HAAR_LEFT_VAL_NAME,
-                        tree->alpha[-tree->left[k]] ) );
+                    cvWriteReal( fs, ICV_HAAR_LEFT_VAL_NAME,
+                        tree->alpha[-tree->left[k]] );
                 }
 
                 if( tree->right[k] > 0 )
                 {
-                    CV_CALL( cvWriteInt( fs, ICV_HAAR_RIGHT_NODE_NAME, tree->right[k] ) );
+                    cvWriteInt( fs, ICV_HAAR_RIGHT_NODE_NAME, tree->right[k] );
                 }
                 else
                 {
-                    CV_CALL( cvWriteReal( fs, ICV_HAAR_RIGHT_VAL_NAME,
-                        tree->alpha[-tree->right[k]] ) );
+                    cvWriteReal( fs, ICV_HAAR_RIGHT_VAL_NAME,
+                        tree->alpha[-tree->right[k]] );
                 }
 
-                CV_CALL( cvEndWriteStruct( fs ) ); /* split */
+                cvEndWriteStruct( fs ); /* split */
             }
 
-            CV_CALL( cvEndWriteStruct( fs ) ); /* tree */
+            cvEndWriteStruct( fs ); /* tree */
         }
 
-        CV_CALL( cvEndWriteStruct( fs ) ); /* trees */
-
-        CV_CALL( cvWriteReal( fs, ICV_HAAR_STAGE_THRESHOLD_NAME,
-                              cascade->stage_classifier[i].threshold) );
+        cvEndWriteStruct( fs ); /* trees */
 
-        CV_CALL( cvWriteInt( fs, ICV_HAAR_PARENT_NAME,
-                              cascade->stage_classifier[i].parent ) );
-        CV_CALL( cvWriteInt( fs, ICV_HAAR_NEXT_NAME,
-                              cascade->stage_classifier[i].next ) );
+        cvWriteReal( fs, ICV_HAAR_STAGE_THRESHOLD_NAME, cascade->stage_classifier[i].threshold);
+        cvWriteInt( fs, ICV_HAAR_PARENT_NAME, cascade->stage_classifier[i].parent );
+        cvWriteInt( fs, ICV_HAAR_NEXT_NAME, cascade->stage_classifier[i].next );
 
-        CV_CALL( cvEndWriteStruct( fs ) ); /* stage */
+        cvEndWriteStruct( fs ); /* stage */
     } /* for each stage */
 
-    CV_CALL( cvEndWriteStruct( fs ) ); /* stages */
-    CV_CALL( cvEndWriteStruct( fs ) ); /* root */
-
-    __END__;
+    cvEndWriteStruct( fs ); /* stages */
+    cvEndWriteStruct( fs ); /* root */
 }
 
 static void*
@@ -2297,16 +1957,12 @@ icvCloneHaarClassifier( const void* struct_ptr )
 {
     CvHaarClassifierCascade* cascade = NULL;
 
-    CV_FUNCNAME( "cvCloneHaarClassifier" );
-
-    __BEGIN__;
-
     int i, j, k, n;
     const CvHaarClassifierCascade* cascade_src =
         (const CvHaarClassifierCascade*) struct_ptr;
 
     n = cascade_src->count;
-    CV_CALL( cascade = icvCreateHaarClassifierCascade(n) );
+    cascade = icvCreateHaarClassifierCascade(n);
     cascade->orig_window_size = cascade_src->orig_window_size;
 
     for( i = 0; i < n; ++i )
@@ -2317,16 +1973,14 @@ icvCloneHaarClassifier( const void* struct_ptr )
         cascade->stage_classifier[i].threshold = cascade_src->stage_classifier[i].threshold;
 
         cascade->stage_classifier[i].count = 0;
-        CV_CALL( cascade->stage_classifier[i].classifier =
+        cascade->stage_classifier[i].classifier =
             (CvHaarClassifier*) cvAlloc( cascade_src->stage_classifier[i].count
-                * sizeof( cascade->stage_classifier[i].classifier[0] ) ) );
+                * sizeof( cascade->stage_classifier[i].classifier[0] ) );
 
         cascade->stage_classifier[i].count = cascade_src->stage_classifier[i].count;
 
         for( j = 0; j < cascade->stage_classifier[i].count; ++j )
-        {
             cascade->stage_classifier[i].classifier[j].haar_feature = NULL;
-        }
 
         for( j = 0; j < cascade->stage_classifier[i].count; ++j )
         {
@@ -2336,12 +1990,12 @@ icvCloneHaarClassifier( const void* struct_ptr )
                 &cascade->stage_classifier[i].classifier[j];
 
             classifier->count = classifier_src->count;
-            CV_CALL( classifier->haar_feature = (CvHaarFeature*) cvAlloc(
+            classifier->haar_feature = (CvHaarFeature*) cvAlloc(
                 classifier->count * ( sizeof( *classifier->haar_feature ) +
                                       sizeof( *classifier->threshold ) +
                                       sizeof( *classifier->left ) +
                                       sizeof( *classifier->right ) ) +
-                (classifier->count + 1) * sizeof( *classifier->alpha ) ) );
+                (classifier->count + 1) * sizeof( *classifier->alpha ) );
             classifier->threshold = (float*) (classifier->haar_feature+classifier->count);
             classifier->left = (int*) (classifier->threshold + classifier->count);
             classifier->right = (int*) (classifier->left + classifier->count);
@@ -2359,8 +2013,6 @@ icvCloneHaarClassifier( const void* struct_ptr )
         }
     }
 
-    __END__;
-
     return cascade;
 }