--- /dev/null
+/*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 "_cvaux.h"
+
+//*F///////////////////////////////////////////////////////////////////////////////////////
+// Name: icvImgToObs_DCT_8u32f_C1R
+// Purpose: The function takes as input an image and returns the sequnce of observations
+// to be used with an embedded HMM; Each observation is top-left block of DCT
+// coefficient matrix.
+// Context:
+// Parameters: img - pointer to the original image ROI
+// imgStep - full row width of the image in bytes
+// roi - width and height of ROI in pixels
+// obs - pointer to resultant observation vectors
+// dctSize - size of the block for which DCT is calculated
+// obsSize - size of top-left block of DCT coeffs matrix, which is treated
+// as observation. Each observation vector consists of
+// obsSize.width * obsSize.height floats.
+// The following conditions should be satisfied:
+// 0 < objSize.width <= dctSize.width,
+// 0 < objSize.height <= dctSize.height.
+// delta - dctBlocks are overlapped and this parameter specifies horizontal
+// and vertical shift.
+// Returns:
+// CV_NO_ERR or error code
+// Notes:
+// The algorithm is following:
+// 1. First, number of observation vectors per row and per column are calculated:
+//
+// Nx = floor((roi.width - dctSize.width + delta.width)/delta.width);
+// Ny = floor((roi.height - dctSize.height + delta.height)/delta.height);
+//
+// So, total number of observation vectors is Nx*Ny, and total size of
+// array obs must be >= Nx*Ny*obsSize.width*obsSize.height*sizeof(float).
+// 2. Observation vectors are calculated in the following loop
+// ( actual implementation may be different ), where
+// I[x1:x2,y1:y2] means block of pixels from source image with
+// x1 <= x < x2, y1 <= y < y2,
+// D[x1:x2,y1:y2] means sub matrix of DCT matrix D.
+// O[x,y] means observation vector that corresponds to position
+// (x*delta.width,y*delta.height) in the source image
+// ( all indices are counted from 0 ).
+//
+// for( y = 0; y < Ny; y++ )
+// {
+// for( x = 0; x < Nx; x++ )
+// {
+// D = DCT(I[x*delta.width : x*delta.width + dctSize.width,
+// y*delta.height : y*delta.height + dctSize.height]);
+// O[x,y] = D[0:obsSize.width, 0:obsSize.height];
+// }
+// }
+//F*/
+
+/*comment out the following line to make DCT be calculated in floating-point arithmetics*/
+//#define _CV_INT_DCT
+
+/* for integer DCT only */
+#define DCT_SCALE 15
+
+#ifdef _CV_INT_DCT
+typedef int work_t;
+
+#define DESCALE CV_DESCALE
+#define SCALE(x) CV_FLT_TO_FIX((x),DCT_SCALE)
+#else
+typedef float work_t;
+
+#define DESCALE(x,n) (float)(x)
+#define SCALE(x) (float)(x)
+#endif
+
+/* calculate dct transform matrix */
+static void icvCalcDCTMatrix( work_t * cfs, int n );
+
+#define MAX_DCT_SIZE 32
+
+static CvStatus CV_STDCALL
+icvImgToObs_DCT_8u32f_C1R( uchar * img, int imgStep, CvSize roi,
+ float *obs, CvSize dctSize,
+ CvSize obsSize, CvSize delta )
+{
+ /* dct transform matrices: horizontal and vertical */
+ work_t tab_x[MAX_DCT_SIZE * MAX_DCT_SIZE / 2 + 2];
+ work_t tab_y[MAX_DCT_SIZE * MAX_DCT_SIZE / 2 + 2];
+
+ /* temporary buffers for dct */
+ work_t temp0[MAX_DCT_SIZE * 4];
+ work_t temp1[MAX_DCT_SIZE * 4];
+ work_t *buffer = 0;
+ work_t *buf_limit;
+
+ double s;
+
+ int y;
+ int Nx, Ny;
+
+ int n1 = dctSize.height, m1 = n1 / 2;
+ int n2 = dctSize.width, m2 = n2 / 2;
+
+ if( !img || !obs )
+ return CV_NULLPTR_ERR;
+
+ if( roi.width <= 0 || roi.height <= 0 )
+ return CV_BADSIZE_ERR;
+
+ if( delta.width <= 0 || delta.height <= 0 )
+ return CV_BADRANGE_ERR;
+
+ if( obsSize.width <= 0 || dctSize.width < obsSize.width ||
+ obsSize.height <= 0 || dctSize.height < obsSize.height )
+ return CV_BADRANGE_ERR;
+
+ if( dctSize.width > MAX_DCT_SIZE || dctSize.height > MAX_DCT_SIZE )
+ return CV_BADRANGE_ERR;
+
+ Nx = (roi.width - dctSize.width + delta.width) / delta.width;
+ Ny = (roi.height - dctSize.height + delta.height) / delta.height;
+
+ if( Nx <= 0 || Ny <= 0 )
+ return CV_BADRANGE_ERR;
+
+ buffer = (work_t *)cvAlloc( roi.width * obsSize.height * sizeof( buffer[0] ));
+ if( !buffer )
+ return CV_OUTOFMEM_ERR;
+
+ icvCalcDCTMatrix( tab_x, dctSize.width );
+ icvCalcDCTMatrix( tab_y, dctSize.height );
+
+ buf_limit = buffer + obsSize.height * roi.width;
+
+ for( y = 0; y < Ny; y++, img += delta.height * imgStep )
+ {
+ int x, i, j, k;
+ work_t k0 = 0;
+
+ /* do transfroms for each column. Calc only first obsSize.height DCT coefficients */
+ for( x = 0; x < roi.width; x++ )
+ {
+ float is = 0;
+ work_t *buf = buffer + x;
+ work_t *tab = tab_y + 2;
+
+ if( n1 & 1 )
+ {
+ is = img[x + m1 * imgStep];
+ k0 = ((work_t) is) * tab[-1];
+ }
+
+ /* first coefficient */
+ for( j = 0; j < m1; j++ )
+ {
+ float t0 = img[x + j * imgStep];
+ float t1 = img[x + (n1 - 1 - j) * imgStep];
+ float t2 = t0 + t1;
+
+ t0 -= t1;
+ temp0[j] = (work_t) t2;
+ is += t2;
+ temp1[j] = (work_t) t0;
+ }
+
+ buf[0] = DESCALE( is * tab[-2], PASS1_SHIFT );
+ if( (buf += roi.width) >= buf_limit )
+ continue;
+
+ /* other coefficients */
+ for( ;; )
+ {
+ s = 0;
+
+ for( k = 0; k < m1; k++ )
+ s += temp1[k] * tab[k];
+
+ buf[0] = DESCALE( s, PASS1_SHIFT );
+ if( (buf += roi.width) >= buf_limit )
+ break;
+
+ tab += m1;
+ s = 0;
+
+ if( n1 & 1 )
+ {
+ k0 = -k0;
+ s = k0;
+ }
+ for( k = 0; k < m1; k++ )
+ s += temp0[k] * tab[k];
+
+ buf[0] = DESCALE( s, PASS1_SHIFT );
+ tab += m1;
+
+ if( (buf += roi.width) >= buf_limit )
+ break;
+ }
+ }
+
+ k0 = 0;
+
+ /* do transforms for rows. */
+ for( x = 0; x + dctSize.width <= roi.width; x += delta.width )
+ {
+ for( i = 0; i < obsSize.height; i++ )
+ {
+ work_t *buf = buffer + x + roi.width * i;
+ work_t *tab = tab_x + 2;
+ float *obs_limit = obs + obsSize.width;
+
+ s = 0;
+
+ if( n2 & 1 )
+ {
+ s = buf[m2];
+ k0 = (work_t) (s * tab[-1]);
+ }
+
+ /* first coefficient */
+ for( j = 0; j < m2; j++ )
+ {
+ work_t t0 = buf[j];
+ work_t t1 = buf[n2 - 1 - j];
+ work_t t2 = t0 + t1;
+
+ t0 -= t1;
+ temp0[j] = (work_t) t2;
+ s += t2;
+ temp1[j] = (work_t) t0;
+ }
+
+ *obs++ = (float) DESCALE( s * tab[-2], PASS2_SHIFT );
+
+ if( obs == obs_limit )
+ continue;
+
+ /* other coefficients */
+ for( ;; )
+ {
+ s = 0;
+
+ for( k = 0; k < m2; k++ )
+ s += temp1[k] * tab[k];
+
+ obs[0] = (float) DESCALE( s, PASS2_SHIFT );
+ if( ++obs == obs_limit )
+ break;
+
+ tab += m2;
+
+ s = 0;
+
+ if( n2 & 1 )
+ {
+ k0 = -k0;
+ s = k0;
+ }
+ for( k = 0; k < m2; k++ )
+ s += temp0[k] * tab[k];
+ obs[0] = (float) DESCALE( s, PASS2_SHIFT );
+
+ tab += m2;
+ if( ++obs == obs_limit )
+ break;
+ }
+ }
+ }
+ }
+
+ cvFree( &buffer );
+ return CV_NO_ERR;
+}
+
+
+static CvStatus CV_STDCALL
+icvImgToObs_DCT_32f_C1R( float * img, int imgStep, CvSize roi,
+ float *obs, CvSize dctSize,
+ CvSize obsSize, CvSize delta )
+{
+ /* dct transform matrices: horizontal and vertical */
+ work_t tab_x[MAX_DCT_SIZE * MAX_DCT_SIZE / 2 + 2];
+ work_t tab_y[MAX_DCT_SIZE * MAX_DCT_SIZE / 2 + 2];
+
+ /* temporary buffers for dct */
+ work_t temp0[MAX_DCT_SIZE * 4];
+ work_t temp1[MAX_DCT_SIZE * 4];
+ work_t *buffer = 0;
+ work_t *buf_limit;
+
+ double s;
+
+ int y;
+ int Nx, Ny;
+
+ int n1 = dctSize.height, m1 = n1 / 2;
+ int n2 = dctSize.width, m2 = n2 / 2;
+
+ if( !img || !obs )
+ return CV_NULLPTR_ERR;
+
+ if( roi.width <= 0 || roi.height <= 0 )
+ return CV_BADSIZE_ERR;
+
+ if( delta.width <= 0 || delta.height <= 0 )
+ return CV_BADRANGE_ERR;
+
+ if( obsSize.width <= 0 || dctSize.width < obsSize.width ||
+ obsSize.height <= 0 || dctSize.height < obsSize.height )
+ return CV_BADRANGE_ERR;
+
+ if( dctSize.width > MAX_DCT_SIZE || dctSize.height > MAX_DCT_SIZE )
+ return CV_BADRANGE_ERR;
+
+ Nx = (roi.width - dctSize.width + delta.width) / delta.width;
+ Ny = (roi.height - dctSize.height + delta.height) / delta.height;
+
+ if( Nx <= 0 || Ny <= 0 )
+ return CV_BADRANGE_ERR;
+
+ buffer = (work_t *)cvAlloc( roi.width * obsSize.height * sizeof( buffer[0] ));
+ if( !buffer )
+ return CV_OUTOFMEM_ERR;
+
+ icvCalcDCTMatrix( tab_x, dctSize.width );
+ icvCalcDCTMatrix( tab_y, dctSize.height );
+
+ buf_limit = buffer + obsSize.height * roi.width;
+
+ imgStep /= sizeof(img[0]);
+
+ for( y = 0; y < Ny; y++, img += delta.height * imgStep )
+ {
+ int x, i, j, k;
+ work_t k0 = 0;
+
+ /* do transfroms for each column. Calc only first obsSize.height DCT coefficients */
+ for( x = 0; x < roi.width; x++ )
+ {
+ float is = 0;
+ work_t *buf = buffer + x;
+ work_t *tab = tab_y + 2;
+
+ if( n1 & 1 )
+ {
+ is = img[x + m1 * imgStep];
+ k0 = ((work_t) is) * tab[-1];
+ }
+
+ /* first coefficient */
+ for( j = 0; j < m1; j++ )
+ {
+ float t0 = img[x + j * imgStep];
+ float t1 = img[x + (n1 - 1 - j) * imgStep];
+ float t2 = t0 + t1;
+
+ t0 -= t1;
+ temp0[j] = (work_t) t2;
+ is += t2;
+ temp1[j] = (work_t) t0;
+ }
+
+ buf[0] = DESCALE( is * tab[-2], PASS1_SHIFT );
+ if( (buf += roi.width) >= buf_limit )
+ continue;
+
+ /* other coefficients */
+ for( ;; )
+ {
+ s = 0;
+
+ for( k = 0; k < m1; k++ )
+ s += temp1[k] * tab[k];
+
+ buf[0] = DESCALE( s, PASS1_SHIFT );
+ if( (buf += roi.width) >= buf_limit )
+ break;
+
+ tab += m1;
+ s = 0;
+
+ if( n1 & 1 )
+ {
+ k0 = -k0;
+ s = k0;
+ }
+ for( k = 0; k < m1; k++ )
+ s += temp0[k] * tab[k];
+
+ buf[0] = DESCALE( s, PASS1_SHIFT );
+ tab += m1;
+
+ if( (buf += roi.width) >= buf_limit )
+ break;
+ }
+ }
+
+ k0 = 0;
+
+ /* do transforms for rows. */
+ for( x = 0; x + dctSize.width <= roi.width; x += delta.width )
+ {
+ for( i = 0; i < obsSize.height; i++ )
+ {
+ work_t *buf = buffer + x + roi.width * i;
+ work_t *tab = tab_x + 2;
+ float *obs_limit = obs + obsSize.width;
+
+ s = 0;
+
+ if( n2 & 1 )
+ {
+ s = buf[m2];
+ k0 = (work_t) (s * tab[-1]);
+ }
+
+ /* first coefficient */
+ for( j = 0; j < m2; j++ )
+ {
+ work_t t0 = buf[j];
+ work_t t1 = buf[n2 - 1 - j];
+ work_t t2 = t0 + t1;
+
+ t0 -= t1;
+ temp0[j] = (work_t) t2;
+ s += t2;
+ temp1[j] = (work_t) t0;
+ }
+
+ *obs++ = (float) DESCALE( s * tab[-2], PASS2_SHIFT );
+
+ if( obs == obs_limit )
+ continue;
+
+ /* other coefficients */
+ for( ;; )
+ {
+ s = 0;
+
+ for( k = 0; k < m2; k++ )
+ s += temp1[k] * tab[k];
+
+ obs[0] = (float) DESCALE( s, PASS2_SHIFT );
+ if( ++obs == obs_limit )
+ break;
+
+ tab += m2;
+
+ s = 0;
+
+ if( n2 & 1 )
+ {
+ k0 = -k0;
+ s = k0;
+ }
+ for( k = 0; k < m2; k++ )
+ s += temp0[k] * tab[k];
+ obs[0] = (float) DESCALE( s, PASS2_SHIFT );
+
+ tab += m2;
+ if( ++obs == obs_limit )
+ break;
+ }
+ }
+ }
+ }
+
+ cvFree( &buffer );
+ return CV_NO_ERR;
+}
+
+
+static void
+icvCalcDCTMatrix( work_t * cfs, int n )
+{
+ static const double sqrt2 = 1.4142135623730950488016887242097;
+ static const double pi = 3.1415926535897932384626433832795;
+
+ static const double sincos[16 * 2] = {
+ 1.00000000000000000, 0.00000000000000006,
+ 0.70710678118654746, 0.70710678118654757,
+ 0.49999999999999994, 0.86602540378443871,
+ 0.38268343236508978, 0.92387953251128674,
+ 0.30901699437494740, 0.95105651629515353,
+ 0.25881904510252074, 0.96592582628906831,
+ 0.22252093395631439, 0.97492791218182362,
+ 0.19509032201612825, 0.98078528040323043,
+ 0.17364817766693033, 0.98480775301220802,
+ 0.15643446504023087, 0.98768834059513777,
+ 0.14231483827328514, 0.98982144188093268,
+ 0.13052619222005157, 0.99144486137381038,
+ 0.12053668025532305, 0.99270887409805397,
+ 0.11196447610330786, 0.99371220989324260,
+ 0.10452846326765346, 0.99452189536827329,
+ 0.09801714032956060, 0.99518472667219693,
+ };
+
+#define ROTATE( c, s, dc, ds ) \
+ { \
+ t = c*dc - s*ds; \
+ s = c*ds + s*dc; \
+ c = t; \
+ }
+
+#define WRITE2( j, a, b ) \
+ { \
+ cfs[j] = SCALE(a); \
+ cfs2[j] = SCALE(b); \
+ }
+
+ double t, scale = 1. / sqrt( (double)n );
+ int i, j, m = n / 2;
+
+ cfs[0] = SCALE( scale );
+ scale *= sqrt2;
+ cfs[1] = SCALE( scale );
+ cfs += 2 - m;
+
+ if( n > 1 )
+ {
+ double a0, b0;
+ double da0, db0;
+ work_t *cfs2 = cfs + m * n;
+
+ if( n <= 16 )
+ {
+ da0 = a0 = sincos[2 * n - 1];
+ db0 = b0 = sincos[2 * n - 2];
+ }
+ else
+ {
+ t = pi / (2 * n);
+ da0 = a0 = cos( t );
+ db0 = b0 = sin( t );
+ }
+
+ /* other rows */
+ for( i = 1; i <= m; i++ )
+ {
+ double a = a0 * scale;
+ double b = b0 * scale;
+ double da = a0 * a0 - b0 * b0;
+ double db = a0 * b0 + a0 * b0;
+
+ cfs += m;
+ cfs2 -= m;
+
+ for( j = 0; j < m; j += 2 )
+ {
+ WRITE2( j, a, b );
+ ROTATE( a, b, da, db );
+ if( j + 1 < m )
+ {
+ WRITE2( j + 1, a, -b );
+ ROTATE( a, b, da, db );
+ }
+ }
+
+ ROTATE( a0, b0, da0, db0 );
+ }
+ }
+#undef ROTATE
+#undef WRITE2
+}
+
+
+CV_IMPL void
+cvImgToObs_DCT( const void* arr, float *obs, CvSize dctSize,
+ CvSize obsSize, CvSize delta )
+{
+ CV_FUNCNAME( "cvImgToObs_DCT" );
+
+ __BEGIN__;
+
+ CvMat stub, *mat = (CvMat*)arr;
+
+ CV_CALL( mat = cvGetMat( arr, &stub ));
+
+ switch( CV_MAT_TYPE( mat->type ))
+ {
+ case CV_8UC1:
+ IPPI_CALL( icvImgToObs_DCT_8u32f_C1R( mat->data.ptr, mat->step,
+ cvGetMatSize(mat), obs,
+ dctSize, obsSize, delta ));
+ break;
+ case CV_32FC1:
+ IPPI_CALL( icvImgToObs_DCT_32f_C1R( mat->data.fl, mat->step,
+ cvGetMatSize(mat), obs,
+ dctSize, obsSize, delta ));
+ break;
+ default:
+ CV_ERROR( CV_StsUnsupportedFormat, "" );
+ }
+
+ __END__;
+}
+
+
+/* End of file. */