www.pudn.com > OpenCV-Intel.zip > cvcorner.cpp

/*M/////////////////////////////////////////////////////////////////////////////////////// 
// 
//  IMPORTANT: READ BEFORE DOWNLOADING, COPYING, INSTALLING OR USING. 
// 
//  By downloading, copying, installing or using the software you agree to this license. 
//  If you do not agree to this license, do not download, install, 
//  copy or use the software. 
// 
// 
//                        Intel License Agreement 
//                For Open Source Computer Vision Library 
// 
// Copyright (C) 2000, Intel Corporation, all rights reserved. 
// Third party copyrights are property of their respective owners. 
// 
// Redistribution and use in source and binary forms, with or without modification, 
// are permitted provided that the following conditions are met: 
// 
//   * Redistribution's of source code must retain the above copyright notice, 
//     this list of conditions and the following disclaimer. 
// 
//   * Redistribution's in binary form must reproduce the above copyright notice, 
//     this list of conditions and the following disclaimer in the documentation 
//     and/or other materials provided with the distribution. 
// 
//   * The name of Intel Corporation may not be used to endorse or promote products 
//     derived from this software without specific prior written permission. 
// 
// This software is provided by the copyright holders and contributors "as is" and 
// any express or implied warranties, including, but not limited to, the implied 
// warranties of merchantability and fitness for a particular purpose are disclaimed. 
// In no event shall the Intel Corporation or contributors be liable for any direct, 
// indirect, incidental, special, exemplary, or consequential damages 
// (including, but not limited to, procurement of substitute goods or services; 
// loss of use, data, or profits; or business interruption) however caused 
// and on any theory of liability, whether in contract, strict liability, 
// or tort (including negligence or otherwise) arising in any way out of 
// the use of this software, even if advised of the possibility of such damage. 
// 
//M*/ 
 
#include "_cv.h" 
#include  
 
 
static void 
icvCalcMinEigenVal( const float* cov, int cov_step, float* dst, 
                    int dst_step, CvSize size, CvMat* buffer ) 
{ 
    int j; 
    float* buf = buffer->data.fl; 
    cov_step /= sizeof(cov[0]); 
    dst_step /= sizeof(dst[0]); 
    buffer->rows = 1; 
 
    for( ; size.height--; cov += cov_step, dst += dst_step ) 
    { 
        for( j = 0; j < size.width; j++ ) 
        { 
            double a = cov[j*3]*0.5; 
            double b = cov[j*3+1]; 
            double c = cov[j*3+2]*0.5; 
             
            buf[j + size.width] = (float)(a + c); 
            buf[j] = (float)((a - c)*(a - c) + b*b); 
        } 
 
        cvPow( buffer, buffer, 0.5 ); 
 
        for( j = 0; j < size.width ; j++ ) 
            dst[j] = (float)(buf[j + size.width] - buf[j]); 
    } 
} 
 
 
static void 
icvCalcHarris( const float* cov, int cov_step, float* dst, 
               int dst_step, CvSize size, CvMat* /*buffer*/, double k ) 
{ 
    int j; 
    cov_step /= sizeof(cov[0]); 
    dst_step /= sizeof(dst[0]); 
 
    for( ; size.height--; cov += cov_step, dst += dst_step ) 
    { 
        for( j = 0; j < size.width; j++ ) 
        { 
            double a = cov[j*3]; 
            double b = cov[j*3+1]; 
            double c = cov[j*3+2]; 
            dst[j] = (float)(a*c - b*b - k*(a + c)*(a + c)); 
        } 
    } 
} 
 
 
static void 
icvCalcEigenValsVecs( const float* cov, int cov_step, float* dst, 
                      int dst_step, CvSize size, CvMat* buffer ) 
{ 
    int j; 
    float* buf = buffer->data.fl; 
    cov_step /= sizeof(cov[0]); 
    dst_step /= sizeof(dst[0]); 
 
    for( ; size.height--; cov += cov_step, dst += dst_step ) 
    { 
        for( j = 0; j < size.width; j++ ) 
        { 
            double a = cov[j*3]*0.5; 
            double b = cov[j*3+1]; 
            double c = cov[j*3+2]*0.5; 
             
            buf[j + size.width] = (float)(a + c); 
            buf[j] = (float)((a - c)*(a - c) + b*b); 
        } 
 
        buffer->rows = 1; 
        cvPow( buffer, buffer, 0.5 ); 
 
        for( j = 0; j < size.width; j++ ) 
        { 
            double a = cov[j*3]; 
            double b = cov[j*3+1]; 
            double c = cov[j*3+2]; 
             
            double l1 = buf[j + size.width] + buf[j]; 
            double l2 = buf[j + size.width] - buf[j]; 
 
            double x = b; 
            double y = l1 - a; 
            double e = fabs(x); 
 
            if( e + fabs(y) < 1e-4 ) 
            { 
                y = b; 
                x = l1 - c; 
            } 
 
            buf[j] = (float)(x*x + y*y + DBL_EPSILON); 
            dst[6*j] = (float)l1; 
            dst[6*j + 2] = (float)x; 
            dst[6*j + 3] = (float)y; 
 
            x = b; 
            y = l2 - a; 
            e = fabs(x); 
 
            if( e + fabs(y) < 1e-4 ) 
            { 
                y = b; 
                x = l2 - c; 
            } 
 
            buf[j + size.width] = (float)(x*x + y*y + DBL_EPSILON); 
            dst[6*j + 1] = (float)l2; 
            dst[6*j + 4] = (float)x; 
            dst[6*j + 5] = (float)y; 
        } 
 
        buffer->rows = 2; 
        cvPow( buffer, buffer, -0.5 ); 
 
        for( j = 0; j < size.width; j++ ) 
        { 
            double t0 = buf[j]*dst[6*j + 2]; 
            double t1 = buf[j]*dst[6*j + 3]; 
 
            dst[6*j + 2] = (float)t0; 
            dst[6*j + 3] = (float)t1; 
 
            t0 = buf[j + size.width]*dst[6*j + 4]; 
            t1 = buf[j + size.width]*dst[6*j + 5]; 
 
            dst[6*j + 4] = (float)t0; 
            dst[6*j + 5] = (float)t1; 
        } 
    } 
} 
 
 
#define ICV_MINEIGENVAL     0 
#define ICV_HARRIS          1 
#define ICV_EIGENVALSVECS   2 
 
static void 
icvCornerEigenValsVecs( const CvMat* src, CvMat* eigenv, int block_size, 
                        int aperture_size, int op_type, double k=0. ) 
{ 
    CvFilterState* dxstate = 0; 
    CvFilterState* dystate = 0; 
    CvFilterState* blurstate = 0; 
    CvMat *tempsrc = 0; 
    CvMat *Dx = 0, *Dy = 0, *cov = 0; 
    CvMat *sqrt_buf = 0; 
 
    int buf_size = 1 << 12; 
     
    CV_FUNCNAME( "icvCornerEigenValsVecs" ); 
 
    __BEGIN__; 
 
    int i, j, y, dst_y = 0, max_dy, delta = 0; 
    int aperture_size0 = aperture_size; 
    int temp_step = 0, d_step; 
    uchar* shifted_ptr = 0; 
    int depth, d_depth, datatype; 
    int stage = CV_START; 
    CvSobelFixedIPPFunc ipp_sobel_vert = 0, ipp_sobel_horiz = 0; 
    CvFilterFixedIPPFunc ipp_scharr_vert = 0, ipp_scharr_horiz = 0; 
    CvFilterFunc opencv_derv_func = 0; 
    CvSize el_size, size, stripe_size; 
    int aligned_width; 
    CvPoint el_anchor; 
    double factorx, factory; 
 
    if( block_size < 3 || !(block_size & 1) ) 
        CV_ERROR( CV_StsOutOfRange, "averaging window size must be an odd number >= 3" ); 
         
    if( aperture_size < 3 && aperture_size != CV_SCHARR || !(aperture_size & 1) ) 
        CV_ERROR( CV_StsOutOfRange, 
        "Derivative filter aperture size must be a positive odd number >=3 or CV_SCHARR" ); 
     
    depth = CV_MAT_DEPTH(src->type); 
    d_depth = depth == CV_8U ? CV_16S : CV_32F; 
    datatype = depth == CV_8U ? cv8u : cv32f; 
 
    size = cvGetMatSize(src); 
    aligned_width = cvAlign(size.width, 4); 
 
    aperture_size = aperture_size == CV_SCHARR ? 3 : aperture_size; 
    el_size = cvSize( aperture_size, aperture_size ); 
    el_anchor = cvPoint( aperture_size/2, aperture_size/2 ); 
 
    if( aperture_size <= 5 && icvFilterSobelVert_8u16s_C1R_p ) 
    { 
        if( depth == CV_8U && aperture_size0 == CV_SCHARR ) 
        { 
            ipp_scharr_vert = icvFilterScharrVert_8u16s_C1R_p; 
            ipp_scharr_horiz = icvFilterScharrHoriz_8u16s_C1R_p; 
        } 
        else if( depth == CV_32F && aperture_size0 == CV_SCHARR ) 
        { 
            ipp_scharr_vert = icvFilterScharrVert_32f_C1R_p; 
            ipp_scharr_horiz = icvFilterScharrHoriz_32f_C1R_p; 
        } 
        else if( depth == CV_8U ) 
        { 
            ipp_sobel_vert = icvFilterSobelVert_8u16s_C1R_p; 
            ipp_sobel_horiz = icvFilterSobelHoriz_8u16s_C1R_p; 
        } 
        else if( depth == CV_32F ) 
        { 
            ipp_sobel_vert = icvFilterSobelVert_32f_C1R_p; 
            ipp_sobel_horiz = icvFilterSobelHoriz_32f_C1R_p; 
        } 
    } 
     
    if( ipp_sobel_vert && ipp_sobel_horiz || 
        ipp_scharr_vert && ipp_scharr_horiz ) 
    { 
        CV_CALL( tempsrc = icvIPPFilterInit( src, buf_size, 
            cvSize(el_size.width,el_size.height + block_size))); 
        shifted_ptr = tempsrc->data.ptr + el_anchor.y*tempsrc->step + 
                      el_anchor.x*CV_ELEM_SIZE(depth); 
        temp_step = tempsrc->step ? tempsrc->step : CV_STUB_STEP; 
        max_dy = tempsrc->rows - aperture_size + 1; 
    } 
    else 
    { 
        ipp_sobel_vert = ipp_sobel_horiz = 0; 
        ipp_scharr_vert = ipp_scharr_horiz = 0; 
        CV_CALL( dxstate = icvSobelInitAlloc( size.width, datatype, aperture_size0, 
                                              CV_ORIGIN_TL, 1, 0 )); 
        CV_CALL( dystate = icvSobelInitAlloc( size.width, datatype, aperture_size0, 
                                              CV_ORIGIN_TL, 0, 1 )); 
        max_dy = buf_size / src->cols; 
        max_dy = MAX( max_dy, aperture_size + block_size ); 
        opencv_derv_func = depth == CV_8U ? (CvFilterFunc)icvSobel_8u16s_C1R : 
                                            (CvFilterFunc)icvSobel_32f_C1R; 
    } 
 
    CV_CALL( Dx = cvCreateMat( max_dy, aligned_width, d_depth )); 
    CV_CALL( Dy = cvCreateMat( max_dy, aligned_width, d_depth )); 
    CV_CALL( cov = cvCreateMat( max_dy + block_size + 1, size.width, CV_32FC3 )); 
    CV_CALL( sqrt_buf = cvCreateMat( 2, size.width, CV_32F )); 
 
    if( opencv_derv_func ) 
        max_dy -= aperture_size - 1; 
    d_step = Dx->step ? Dx->step : CV_STUB_STEP; 
 
    CV_CALL( blurstate = icvBlurInitAlloc( size.width, cv32f, 3, block_size )); 
    blurstate->divisor = 1; // avoid scaling 
    stripe_size = size; 
 
    factorx = (double)(1 << (aperture_size - 1)) * block_size; 
    if( aperture_size0 == CV_SCHARR ) 
        factorx *= 2; 
    if( depth == CV_8U ) 
        factorx *= 255.; 
    factory = factorx = 1./factorx; 
    if( ipp_sobel_vert ) 
        factory = -factory; 
 
    for( y = 0; y < size.height; y += delta ) 
    { 
        if( opencv_derv_func ) 
        { 
            delta = MIN( size.height - y, max_dy ); 
            if( y + delta == size.height ) 
                stage = stage & CV_START ? CV_START + CV_END : CV_END; 
             
            stripe_size.height = delta; 
            IPPI_CALL( opencv_derv_func( src->data.ptr + y*src->step, src->step, Dx->data.ptr, 
                                         Dx->step, &stripe_size, dxstate, stage )); 
            stripe_size.height = delta; 
            IPPI_CALL( opencv_derv_func( src->data.ptr + y*src->step, src->step, Dy->data.ptr, 
                                         Dy->step, &stripe_size, dystate, stage )); 
        } 
        else 
        { 
            delta = icvIPPFilterNextStripe( src, tempsrc, y, el_size, el_anchor ); 
            stripe_size.height = delta; 
 
            if( ipp_sobel_vert ) 
            { 
                IPPI_CALL( ipp_sobel_vert( shifted_ptr, temp_step, 
                        Dx->data.ptr, d_step, stripe_size, 
                        aperture_size*10 + aperture_size )); 
                IPPI_CALL( ipp_sobel_horiz( shifted_ptr, temp_step, 
                        Dy->data.ptr, d_step, stripe_size, 
                        aperture_size*10 + aperture_size )); 
            } 
            else /*if( ipp_scharr_vert )*/ 
            { 
                IPPI_CALL( ipp_scharr_vert( shifted_ptr, temp_step, 
                        Dx->data.ptr, d_step, stripe_size )); 
                IPPI_CALL( ipp_scharr_horiz( shifted_ptr, temp_step, 
                        Dy->data.ptr, d_step, stripe_size )); 
            } 
        } 
 
        for( i = 0; i < stripe_size.height; i++ ) 
        { 
            float* cov_data = (float*)(cov->data.ptr + i*cov->step); 
            if( d_depth == CV_16S ) 
            { 
                const short* dxdata = (const short*)(Dx->data.ptr + i*Dx->step); 
                const short* dydata = (const short*)(Dy->data.ptr + i*Dy->step); 
 
                for( j = 0; j < size.width; j++ ) 
                { 
                    double dx = dxdata[j]*factorx; 
                    double dy = dydata[j]*factory; 
 
                    cov_data[j*3] = (float)(dx*dx); 
                    cov_data[j*3+1] = (float)(dx*dy); 
                    cov_data[j*3+2] = (float)(dy*dy); 
                } 
            } 
            else 
            { 
                const float* dxdata = (const float*)(Dx->data.ptr + i*Dx->step); 
                const float* dydata = (const float*)(Dy->data.ptr + i*Dy->step); 
 
                for( j = 0; j < size.width; j++ ) 
                { 
                    double dx = dxdata[j]*factorx; 
                    double dy = dydata[j]*factory; 
 
                    cov_data[j*3] = (float)(dx*dx); 
                    cov_data[j*3+1] = (float)(dx*dy); 
                    cov_data[j*3+2] = (float)(dy*dy); 
                } 
            } 
        } 
 
        if( y + stripe_size.height >= size.height ) 
            stage = stage & CV_START ? CV_START + CV_END : CV_END; 
 
        IPPI_CALL( icvBlur_32f_CnR( cov->data.fl, cov->step, 
                                    cov->data.fl, cov->step, 
                                    &stripe_size, blurstate, stage )); 
 
        if( op_type == ICV_MINEIGENVAL ) 
            icvCalcMinEigenVal( cov->data.fl, cov->step, 
                (float*)(eigenv->data.ptr + dst_y*eigenv->step), eigenv->step, 
                stripe_size, sqrt_buf ); 
        else if( op_type == ICV_HARRIS ) 
            icvCalcHarris( cov->data.fl, cov->step, 
                (float*)(eigenv->data.ptr + dst_y*eigenv->step), eigenv->step, 
                stripe_size, sqrt_buf, k ); 
        else if( op_type == ICV_EIGENVALSVECS ) 
            icvCalcEigenValsVecs( cov->data.fl, cov->step, 
                (float*)(eigenv->data.ptr + dst_y*eigenv->step), eigenv->step, 
                stripe_size, sqrt_buf ); 
 
        dst_y += stripe_size.height; 
 
        stage = CV_MIDDLE; 
    } 
 
    __END__; 
 
    icvFilterFree( &dxstate ); 
    icvFilterFree( &dystate ); 
    icvFilterFree( &blurstate ); 
    cvReleaseMat( &Dx ); 
    cvReleaseMat( &Dy ); 
    cvReleaseMat( &cov ); 
    cvReleaseMat( &sqrt_buf ); 
    cvReleaseMat( &tempsrc ); 
} 
 
 
CV_IMPL void 
cvCornerMinEigenVal( const void* srcarr, void* eigenvarr, 
                     int block_size, int aperture_size ) 
{ 
    CV_FUNCNAME( "cvCornerMinEigenVal" ); 
 
    __BEGIN__; 
 
    CvMat stub, *src = (CvMat*)srcarr; 
    CvMat eigstub, *eigenv = (CvMat*)eigenvarr; 
 
    CV_CALL( src = cvGetMat( srcarr, &stub )); 
    CV_CALL( eigenv = cvGetMat( eigenv, &eigstub )); 
 
    if( CV_MAT_TYPE(src->type) != CV_8UC1 && CV_MAT_TYPE(src->type) != CV_32FC1 || 
        CV_MAT_TYPE(eigenv->type) != CV_32FC1 ) 
        CV_ERROR( CV_StsUnsupportedFormat, "Input must be 8uC1 or 32fC1, output must be 32fC1" ); 
 
    if( !CV_ARE_SIZES_EQ( src, eigenv )) 
        CV_ERROR( CV_StsUnmatchedSizes, "" ); 
 
    CV_CALL( icvCornerEigenValsVecs( src, eigenv, block_size, aperture_size, ICV_MINEIGENVAL )); 
 
    __END__; 
} 
 
 
CV_IMPL void 
cvCornerHarris( const CvArr* srcarr, CvArr* harris_responce, 
                int block_size, int aperture_size, double k ) 
{ 
    CV_FUNCNAME( "cvCornerHarris" ); 
 
    __BEGIN__; 
 
    CvMat stub, *src = (CvMat*)srcarr; 
    CvMat eigstub, *eigenv = (CvMat*)harris_responce; 
 
    CV_CALL( src = cvGetMat( srcarr, &stub )); 
    CV_CALL( eigenv = cvGetMat( eigenv, &eigstub )); 
 
    if( CV_MAT_TYPE(src->type) != CV_8UC1 && CV_MAT_TYPE(src->type) != CV_32FC1 || 
        CV_MAT_TYPE(eigenv->type) != CV_32FC1 ) 
        CV_ERROR( CV_StsUnsupportedFormat, "Input must be 8uC1 or 32fC1, output must be 32fC1" ); 
 
    if( !CV_ARE_SIZES_EQ( src, eigenv )) 
        CV_ERROR( CV_StsUnmatchedSizes, "" ); 
 
    CV_CALL( icvCornerEigenValsVecs( src, eigenv, block_size, aperture_size, ICV_HARRIS, k )); 
 
    __END__; 
} 
 
 
CV_IMPL void 
cvCornerEigenValsAndVecs( const void* srcarr, void* eigenvarr, 
                          int block_size, int aperture_size ) 
{ 
    CV_FUNCNAME( "cvCornerEigenValsAndVecs" ); 
 
    __BEGIN__; 
 
    CvMat stub, *src = (CvMat*)srcarr; 
    CvMat eigstub, *eigenv = (CvMat*)eigenvarr; 
 
    CV_CALL( src = cvGetMat( srcarr, &stub )); 
    CV_CALL( eigenv = cvGetMat( eigenv, &eigstub )); 
 
    if( CV_MAT_CN(eigenv->type)*eigenv->cols != src->cols*6 || 
        eigenv->rows != src->rows ) 
        CV_ERROR( CV_StsUnmatchedSizes, "Output array should be 6 times " 
            "wider than the input array and they should have the same height"); 
 
    if( CV_MAT_TYPE(src->type) != CV_8UC1 && CV_MAT_TYPE(src->type) != CV_32FC1 || 
        CV_MAT_TYPE(eigenv->type) != CV_32FC1 ) 
        CV_ERROR( CV_StsUnsupportedFormat, "Input must be 8uC1 or 32fC1, output must be 32fC1" ); 
 
    CV_CALL( icvCornerEigenValsVecs( src, eigenv, block_size, aperture_size, ICV_EIGENVALSVECS )); 
 
    __END__; 
} 
 
 
CV_IMPL void 
cvPreCornerDetect( const void* srcarr, void* dstarr, int aperture_size ) 
{ 
    CvFilterState* dxstate = 0; 
    CvFilterState* dystate = 0; 
    CvFilterState* d2xstate = 0; 
    CvFilterState* d2ystate = 0; 
    CvFilterState* dxystate = 0; 
    CvMat *Dx = 0, *Dy = 0, *D2x = 0, *D2y = 0, *Dxy = 0; 
    CvMat *tempsrc = 0; 
     
    int buf_size = 1 << 12; 
 
    CV_FUNCNAME( "cvPreCornerDetect" ); 
 
    __BEGIN__; 
 
    int i, j, y, dst_y = 0, max_dy, delta = 0; 
    int temp_step = 0, d_step; 
    uchar* shifted_ptr = 0; 
    int depth, d_depth, datatype; 
    int stage = CV_START; 
    CvSobelFixedIPPFunc ipp_sobel_vert = 0, ipp_sobel_horiz = 0, 
                        ipp_sobel_vert_second = 0, ipp_sobel_horiz_second = 0, 
                        ipp_sobel_cross = 0; 
    CvFilterFunc opencv_derv_func = 0; 
    CvSize el_size, size, stripe_size; 
    int aligned_width; 
    CvPoint el_anchor; 
    double factor; 
    CvMat stub, *src = (CvMat*)srcarr; 
    CvMat dststub, *dst = (CvMat*)dstarr; 
 
    CV_CALL( src = cvGetMat( srcarr, &stub )); 
    CV_CALL( dst = cvGetMat( dst, &dststub )); 
 
    if( CV_MAT_TYPE(src->type) != CV_8UC1 && CV_MAT_TYPE(src->type) != CV_32FC1 || 
        CV_MAT_TYPE(dst->type) != CV_32FC1 ) 
        CV_ERROR( CV_StsUnsupportedFormat, "Input must be 8uC1 or 32fC1, output must be 32fC1" ); 
 
    if( !CV_ARE_SIZES_EQ( src, dst )) 
        CV_ERROR( CV_StsUnmatchedSizes, "" ); 
 
    if( aperture_size == CV_SCHARR ) 
        CV_ERROR( CV_StsOutOfRange, "CV_SCHARR is not supported by this function" ); 
 
    if( aperture_size < 3 || aperture_size > 7 || !(aperture_size & 1) ) 
        CV_ERROR( CV_StsOutOfRange, 
        "Derivative filter aperture size must be 3, 5 or 7" ); 
     
    depth = CV_MAT_DEPTH(src->type); 
    d_depth = depth == CV_8U ? CV_16S : CV_32F; 
    datatype = depth == CV_8U ? cv8u : cv32f; 
 
    size = cvGetMatSize(src); 
    aligned_width = cvAlign(size.width, 4); 
 
    el_size = cvSize( aperture_size, aperture_size ); 
    el_anchor = cvPoint( aperture_size/2, aperture_size/2 ); 
 
    if( aperture_size <= 5 && icvFilterSobelVert_8u16s_C1R_p ) 
    { 
        if( depth == CV_8U ) 
        { 
            ipp_sobel_vert = icvFilterSobelVert_8u16s_C1R_p; 
            ipp_sobel_horiz = icvFilterSobelHoriz_8u16s_C1R_p; 
            ipp_sobel_vert_second = icvFilterSobelVertSecond_8u16s_C1R_p; 
            ipp_sobel_horiz_second = icvFilterSobelHorizSecond_8u16s_C1R_p; 
            ipp_sobel_cross = icvFilterSobelCross_8u16s_C1R_p; 
        } 
        else if( depth == CV_32F ) 
        { 
            ipp_sobel_vert = icvFilterSobelVert_32f_C1R_p; 
            ipp_sobel_horiz = icvFilterSobelHoriz_32f_C1R_p; 
            ipp_sobel_vert_second = icvFilterSobelVertSecond_32f_C1R_p; 
            ipp_sobel_horiz_second = icvFilterSobelHorizSecond_32f_C1R_p; 
            ipp_sobel_cross = icvFilterSobelCross_32f_C1R_p; 
        } 
    } 
     
    if( ipp_sobel_vert && ipp_sobel_horiz && ipp_sobel_vert_second && 
        ipp_sobel_horiz_second && ipp_sobel_cross ) 
    { 
        CV_CALL( tempsrc = icvIPPFilterInit( src, buf_size, el_size )); 
        shifted_ptr = tempsrc->data.ptr + el_anchor.y*tempsrc->step + 
                      el_anchor.x*CV_ELEM_SIZE(depth); 
        temp_step = tempsrc->step ? tempsrc->step : CV_STUB_STEP; 
        max_dy = tempsrc->rows - aperture_size + 1; 
    } 
    else 
    { 
        ipp_sobel_vert = ipp_sobel_horiz = 0; 
        ipp_sobel_vert_second = ipp_sobel_horiz_second = ipp_sobel_cross = 0; 
        CV_CALL( dxstate = icvSobelInitAlloc( size.width, datatype, aperture_size, 
                                              CV_ORIGIN_TL, 1, 0 )); 
        CV_CALL( dystate = icvSobelInitAlloc( size.width, datatype, aperture_size, 
                                              CV_ORIGIN_TL, 0, 1 )); 
        CV_CALL( d2xstate = icvSobelInitAlloc( size.width, datatype, aperture_size, 
                                               CV_ORIGIN_TL, 2, 0 )); 
        CV_CALL( d2ystate = icvSobelInitAlloc( size.width, datatype, aperture_size, 
                                               CV_ORIGIN_TL, 0, 2 )); 
        CV_CALL( dxystate = icvSobelInitAlloc( size.width, datatype, aperture_size, 
                                               CV_ORIGIN_TL, 1, 1 )); 
        max_dy = buf_size / src->cols; 
        max_dy = MAX( max_dy, aperture_size ); 
        opencv_derv_func = depth == CV_8U ? (CvFilterFunc)icvSobel_8u16s_C1R : 
                                            (CvFilterFunc)icvSobel_32f_C1R; 
    } 
 
    CV_CALL( Dx = cvCreateMat( max_dy, aligned_width, d_depth )); 
    CV_CALL( Dy = cvCreateMat( max_dy, aligned_width, d_depth )); 
    CV_CALL( D2x = cvCreateMat( max_dy, aligned_width, d_depth )); 
    CV_CALL( D2y = cvCreateMat( max_dy, aligned_width, d_depth )); 
    CV_CALL( Dxy = cvCreateMat( max_dy, aligned_width, d_depth )); 
 
    if( opencv_derv_func ) 
        max_dy -= aperture_size - 1; 
    d_step = Dx->step ? Dx->step : CV_STUB_STEP; 
 
    stripe_size = size; 
 
    factor = 1 << (aperture_size - 1); 
    if( depth == CV_8U ) 
        factor *= 255; 
    factor = 1./(factor * factor * factor); 
 
    aperture_size = aperture_size * 10 + aperture_size; 
 
    for( y = 0; y < size.height; y += delta ) 
    { 
        if( opencv_derv_func ) 
        { 
            delta = MIN( size.height - y, max_dy ); 
            if( y + delta == size.height ) 
                stage = stage & CV_START ? CV_START + CV_END : CV_END; 
             
            stripe_size.height = delta; 
            IPPI_CALL( opencv_derv_func( src->data.ptr + y*src->step, src->step, Dx->data.ptr, 
                                         d_step, &stripe_size, dxstate, stage )); 
            stripe_size.height = delta; 
            IPPI_CALL( opencv_derv_func( src->data.ptr + y*src->step, src->step, Dy->data.ptr, 
                                         d_step, &stripe_size, dystate, stage )); 
            stripe_size.height = delta; 
            IPPI_CALL( opencv_derv_func( src->data.ptr + y*src->step, src->step, D2x->data.ptr, 
                                         d_step, &stripe_size, d2xstate, stage )); 
            stripe_size.height = delta; 
            IPPI_CALL( opencv_derv_func( src->data.ptr + y*src->step, src->step, D2y->data.ptr, 
                                         d_step, &stripe_size, d2ystate, stage )); 
            stripe_size.height = delta; 
            IPPI_CALL( opencv_derv_func( src->data.ptr + y*src->step, src->step, Dxy->data.ptr, 
                                         d_step, &stripe_size, dxystate, stage )); 
        } 
        else 
        { 
            delta = icvIPPFilterNextStripe( src, tempsrc, y, el_size, el_anchor ); 
            stripe_size.height = delta; 
 
            IPPI_CALL( ipp_sobel_vert( shifted_ptr, temp_step, 
                Dx->data.ptr, d_step, stripe_size, aperture_size )); 
            IPPI_CALL( ipp_sobel_horiz( shifted_ptr, temp_step, 
                Dy->data.ptr, d_step, stripe_size, aperture_size )); 
            IPPI_CALL( ipp_sobel_vert_second( shifted_ptr, temp_step, 
                D2x->data.ptr, d_step, stripe_size, aperture_size )); 
            IPPI_CALL( ipp_sobel_horiz_second( shifted_ptr, temp_step, 
                D2y->data.ptr, d_step, stripe_size, aperture_size )); 
            IPPI_CALL( ipp_sobel_cross( shifted_ptr, temp_step, 
                Dxy->data.ptr, d_step, stripe_size, aperture_size )); 
        } 
 
        for( i = 0; i < stripe_size.height; i++, dst_y++ ) 
        { 
            float* dstdata = (float*)(dst->data.ptr + dst_y*dst->step); 
             
            if( d_depth == CV_16S ) 
            { 
                const short* dxdata = (const short*)(Dx->data.ptr + i*Dx->step); 
                const short* dydata = (const short*)(Dy->data.ptr + i*Dy->step); 
                const short* d2xdata = (const short*)(D2x->data.ptr + i*D2x->step); 
                const short* d2ydata = (const short*)(D2y->data.ptr + i*D2y->step); 
                const short* dxydata = (const short*)(Dxy->data.ptr + i*Dxy->step); 
                 
                for( j = 0; j < stripe_size.width; j++ ) 
                { 
                    double dx = dxdata[j]; 
                    double dx2 = dx * dx; 
                    double dy = dydata[j]; 
                    double dy2 = dy * dy; 
 
                    dstdata[j] = (float)(factor*(dx2*d2ydata[j] + dy2*d2xdata[j] - 2*dx*dy*dxydata[j])); 
                } 
            } 
            else 
            { 
                const float* dxdata = (const float*)(Dx->data.ptr + i*Dx->step); 
                const float* dydata = (const float*)(Dy->data.ptr + i*Dy->step); 
                const float* d2xdata = (const float*)(D2x->data.ptr + i*D2x->step); 
                const float* d2ydata = (const float*)(D2y->data.ptr + i*D2y->step); 
                const float* dxydata = (const float*)(Dxy->data.ptr + i*Dxy->step); 
                 
                for( j = 0; j < stripe_size.width; j++ ) 
                { 
                    double dx = dxdata[j]; 
                    double dy = dydata[j]; 
                    dstdata[j] = (float)(factor*(dx*dx*d2ydata[j] + dy*dy*d2xdata[j] - 2*dx*dy*dxydata[j])); 
                } 
            } 
        } 
 
        stage = CV_MIDDLE; 
    } 
 
    __END__; 
 
    icvFilterFree( &dxstate ); 
    icvFilterFree( &dystate ); 
    icvFilterFree( &d2xstate ); 
    icvFilterFree( &d2ystate ); 
    icvFilterFree( &dxystate ); 
    cvReleaseMat( &Dx ); 
    cvReleaseMat( &Dy ); 
    cvReleaseMat( &D2x ); 
    cvReleaseMat( &D2y ); 
    cvReleaseMat( &Dxy ); 
    cvReleaseMat( &tempsrc ); 
} 
 
/* End of file */