1 /*M///////////////////////////////////////////////////////////////////////////////////////
2 //
3 //  IMPORTANT: READ BEFORE DOWNLOADING, COPYING, INSTALLING OR USING.
4 //
5 //  By downloading, copying, installing or using the software you agree to this license.
6 //  If you do not agree to this license, do not download, install,
7 //  copy or use the software.
8 //
9 //
10 //                        Intel License Agreement
11 //                For Open Source Computer Vision Library
12 //
13 // Copyright (C) 2000, Intel Corporation, all rights reserved.
14 // Third party copyrights are property of their respective owners.
15 //
16 // Redistribution and use in source and binary forms, with or without modification,
17 // are permitted provided that the following conditions are met:
18 //
19 //   * Redistribution's of source code must retain the above copyright notice,
20 //     this list of conditions and the following disclaimer.
21 //
22 //   * Redistribution's in binary form must reproduce the above copyright notice,
23 //     this list of conditions and the following disclaimer in the documentation
24 //     and/or other materials provided with the distribution.
25 //
26 //   * The name of Intel Corporation may not be used to endorse or promote products
27 //     derived from this software without specific prior written permission.
28 //
29 // This software is provided by the copyright holders and contributors "as is" and
30 // any express or implied warranties, including, but not limited to, the implied
31 // warranties of merchantability and fitness for a particular purpose are disclaimed.
32 // In no event shall the Intel Corporation or contributors be liable for any direct,
33 // indirect, incidental, special, exemplary, or consequential damages
34 // (including, but not limited to, procurement of substitute goods or services;
35 // loss of use, data, or profits; or business interruption) however caused
36 // and on any theory of liability, whether in contract, strict liability,
37 // or tort (including negligence or otherwise) arising in any way out of
38 // the use of this software, even if advised of the possibility of such damage.
39 //
40 //M*/
41 
42 #include "_cv.h"
43 
44 #define ICV_DEF_INTEGRAL_OP_C1( flavor, arrtype, sumtype, sqsumtype, worktype,  \
45                                 cast_macro, cast_sqr_macro )    \
46 static CvStatus CV_STDCALL                                      \
47 icvIntegralImage_##flavor##_C1R( const arrtype* src, int srcstep,\
48                                  sumtype* sum, int sumstep,     \
49                                  sqsumtype* sqsum, int sqsumstep,\
50                                  sumtype* tilted, int tiltedstep,\
51                                  CvSize size )                  \
52 {                                                               \
53     int x, y;                                                   \
54     sumtype s;                                                  \
55     sqsumtype sq;                                               \
56     sumtype* buf = 0;                                           \
57                                                                 \
58     srcstep /= sizeof(src[0]);                                  \
59                                                                 \
60     memset( sum, 0, (size.width+1)*sizeof(sum[0]));             \
61     sumstep /= sizeof(sum[0]);                                  \
62     sum += sumstep + 1;                                         \
63                                                                 \
64     if( sqsum )                                                 \
65     {                                                           \
66         memset( sqsum, 0, (size.width+1)*sizeof(sqsum[0]));     \
67         sqsumstep /= sizeof(sqsum[0]);                          \
68         sqsum += sqsumstep + 1;                                 \
69     }                                                           \
70                                                                 \
71     if( tilted )                                                \
72     {                                                           \
73         memset( tilted, 0, (size.width+1)*sizeof(tilted[0]));   \
74         tiltedstep /= sizeof(tilted[0]);                        \
75         tilted += tiltedstep + 1;                               \
76     }                                                           \
77                                                                 \
78     if( sqsum == 0 && tilted == 0 )                             \
79     {                                                           \
80         for( y = 0; y < size.height; y++, src += srcstep,       \
81                                           sum += sumstep )      \
82         {                                                       \
83             sum[-1] = 0;                                        \
84             for( x = 0, s = 0; x < size.width; x++ )            \
85             {                                                   \
86                 sumtype t = cast_macro(src[x]);                 \
87                 s += t;                                         \
88                 sum[x] = sum[x - sumstep] + s;                  \
89             }                                                   \
90         }                                                       \
91     }                                                           \
92     else if( tilted == 0 )                                      \
93     {                                                           \
94         for( y = 0; y < size.height; y++, src += srcstep,       \
95                         sum += sumstep, sqsum += sqsumstep )    \
96         {                                                       \
97             sum[-1] = 0;                                        \
98             sqsum[-1] = 0;                                      \
99                                                                 \
100             for( x = 0, s = 0, sq = 0; x < size.width; x++ )    \
101             {                                                   \
102                 worktype it = src[x];                           \
103                 sumtype t = cast_macro(it);                     \
104                 sqsumtype tq = cast_sqr_macro(it);              \
105                 s += t;                                         \
106                 sq += tq;                                       \
107                 t = sum[x - sumstep] + s;                       \
108                 tq = sqsum[x - sqsumstep] + sq;                 \
109                 sum[x] = t;                                     \
110                 sqsum[x] = tq;                                  \
111             }                                                   \
112         }                                                       \
113     }                                                           \
114     else                                                        \
115     {                                                           \
116         if( sqsum == 0 )                                        \
117         {                                                       \
118             assert(0);                                          \
119             return CV_NULLPTR_ERR;                              \
120         }                                                       \
121                                                                 \
122         buf = (sumtype*)cvStackAlloc((size.width + 1 )* sizeof(buf[0]));\
123         sum[-1] = tilted[-1] = 0;                               \
124         sqsum[-1] = 0;                                          \
125                                                                 \
126         for( x = 0, s = 0, sq = 0; x < size.width; x++ )        \
127         {                                                       \
128             worktype it = src[x];                               \
129             sumtype t = cast_macro(it);                         \
130             sqsumtype tq = cast_sqr_macro(it);                  \
131             buf[x] = tilted[x] = t;                             \
132             s += t;                                             \
133             sq += tq;                                           \
134             sum[x] = s;                                         \
135             sqsum[x] = sq;                                      \
136         }                                                       \
137                                                                 \
138         if( size.width == 1 )                                   \
139             buf[1] = 0;                                         \
140                                                                 \
141         for( y = 1; y < size.height; y++ )                      \
142         {                                                       \
143             worktype it;                                        \
144             sumtype t0;                                         \
145             sqsumtype tq0;                                      \
146                                                                 \
147             src += srcstep;                                     \
148             sum += sumstep;                                     \
149             sqsum += sqsumstep;                                 \
150             tilted += tiltedstep;                               \
151                                                                 \
152             it = src[0/*x*/];                                   \
153             s = t0 = cast_macro(it);                            \
154             sq = tq0 = cast_sqr_macro(it);                      \
155                                                                 \
156             sum[-1] = 0;                                        \
157             sqsum[-1] = 0;                                      \
158             /*tilted[-1] = buf[0];*/                            \
159             tilted[-1] = tilted[-tiltedstep];                   \
160                                                                 \
161             sum[0] = sum[-sumstep] + t0;                        \
162             sqsum[0] = sqsum[-sqsumstep] + tq0;                 \
163             tilted[0] = tilted[-tiltedstep] + t0 + buf[1];      \
164                                                                 \
165             for( x = 1; x < size.width - 1; x++ )               \
166             {                                                   \
167                 sumtype t1 = buf[x];                            \
168                 buf[x-1] = t1 + t0;                             \
169                 it = src[x];                                    \
170                 t0 = cast_macro(it);                            \
171                 tq0 = cast_sqr_macro(it);                       \
172                 s += t0;                                        \
173                 sq += tq0;                                      \
174                 sum[x] = sum[x - sumstep] + s;                  \
175                 sqsum[x] = sqsum[x - sqsumstep] + sq;           \
176                 t1 += buf[x+1] + t0 + tilted[x - tiltedstep - 1];\
177                 tilted[x] = t1;                                 \
178             }                                                   \
179                                                                 \
180             if( size.width > 1 )                                \
181             {                                                   \
182                 sumtype t1 = buf[x];                            \
183                 buf[x-1] = t1 + t0;                             \
184                 it = src[x];    /*+*/                           \
185                 t0 = cast_macro(it);                            \
186                 tq0 = cast_sqr_macro(it);                       \
187                 s += t0;                                        \
188                 sq += tq0;                                      \
189                 sum[x] = sum[x - sumstep] + s;                  \
190                 sqsum[x] = sqsum[x - sqsumstep] + sq;           \
191                 tilted[x] = t0 + t1 + tilted[x - tiltedstep - 1];\
192                 buf[x] = t0;                                    \
193             }                                                   \
194         }                                                       \
195     }                                                           \
196                                                                 \
197     return CV_OK;                                               \
198 }
199 
200 
201 ICV_DEF_INTEGRAL_OP_C1( 8u32s, uchar, int, double, int, CV_NOP, CV_8TO32F_SQR )
202 ICV_DEF_INTEGRAL_OP_C1( 8u64f, uchar, double, double, int, CV_8TO32F, CV_8TO32F_SQR )
203 ICV_DEF_INTEGRAL_OP_C1( 32f64f, float, double, double, double, CV_NOP, CV_SQR )
204 ICV_DEF_INTEGRAL_OP_C1( 64f, double, double, double, double, CV_NOP, CV_SQR )
205 
206 
207 #define ICV_DEF_INTEGRAL_OP_CN( flavor, arrtype, sumtype, sqsumtype,    \
208                                 worktype, cast_macro, cast_sqr_macro )  \
209 static CvStatus CV_STDCALL                                      \
210 icvIntegralImage_##flavor##_CnR( const arrtype* src, int srcstep,\
211                                  sumtype* sum, int sumstep,     \
212                                  sqsumtype* sqsum, int sqsumstep,\
213                                  CvSize size, int cn )          \
214 {                                                               \
215     int x, y;                                                   \
216     srcstep /= sizeof(src[0]);                                  \
217                                                                 \
218     memset( sum, 0, (size.width+1)*cn*sizeof(sum[0]));          \
219     sumstep /= sizeof(sum[0]);                                  \
220     sum += sumstep + cn;                                        \
221                                                                 \
222     if( sqsum )                                                 \
223     {                                                           \
224         memset( sqsum, 0, (size.width+1)*cn*sizeof(sqsum[0]));  \
225         sqsumstep /= sizeof(sqsum[0]);                          \
226         sqsum += sqsumstep + cn;                                \
227     }                                                           \
228                                                                 \
229     size.width *= cn;                                           \
230                                                                 \
231     if( sqsum == 0 )                                            \
232     {                                                           \
233         for( y = 0; y < size.height; y++, src += srcstep,       \
234                                           sum += sumstep )      \
235         {                                                       \
236             for( x = -cn; x < 0; x++ )                          \
237                 sum[x] = 0;                                     \
238                                                                 \
239             for( x = 0; x < size.width; x++ )                   \
240                 sum[x] = cast_macro(src[x]) + sum[x - cn];      \
241                                                                 \
242             for( x = 0; x < size.width; x++ )                   \
243                 sum[x] = sum[x] + sum[x - sumstep];             \
244         }                                                       \
245     }                                                           \
246     else                                                        \
247     {                                                           \
248         for( y = 0; y < size.height; y++, src += srcstep,       \
249                         sum += sumstep, sqsum += sqsumstep )    \
250         {                                                       \
251             for( x = -cn; x < 0; x++ )                          \
252             {                                                   \
253                 sum[x] = 0;                                     \
254                 sqsum[x] = 0;                                   \
255             }                                                   \
256                                                                 \
257             for( x = 0; x < size.width; x++ )                   \
258             {                                                   \
259                 worktype it = src[x];                           \
260                 sumtype t = cast_macro(it) + sum[x-cn];         \
261                 sqsumtype tq = cast_sqr_macro(it) + sqsum[x-cn];\
262                 sum[x] = t;                                     \
263                 sqsum[x] = tq;                                  \
264             }                                                   \
265                                                                 \
266             for( x = 0; x < size.width; x++ )                   \
267             {                                                   \
268                 sumtype t = sum[x] + sum[x - sumstep];          \
269                 sqsumtype tq = sqsum[x] + sqsum[x - sqsumstep]; \
270                 sum[x] = t;                                     \
271                 sqsum[x] = tq;                                  \
272             }                                                   \
273         }                                                       \
274     }                                                           \
275                                                                 \
276     return CV_OK;                                               \
277 }
278 
279 
280 ICV_DEF_INTEGRAL_OP_CN( 8u32s, uchar, int, double, int, CV_NOP, CV_8TO32F_SQR )
281 ICV_DEF_INTEGRAL_OP_CN( 8u64f, uchar, double, double, int, CV_8TO32F, CV_8TO32F_SQR )
282 ICV_DEF_INTEGRAL_OP_CN( 32f64f, float, double, double, double, CV_NOP, CV_SQR )
283 ICV_DEF_INTEGRAL_OP_CN( 64f, double, double, double, double, CV_NOP, CV_SQR )
284 
285 
icvInitIntegralImageTable(CvFuncTable * table_c1,CvFuncTable * table_cn)286 static void icvInitIntegralImageTable( CvFuncTable* table_c1, CvFuncTable* table_cn )
287 {
288     table_c1->fn_2d[CV_8U] = (void*)icvIntegralImage_8u64f_C1R;
289     table_c1->fn_2d[CV_32F] = (void*)icvIntegralImage_32f64f_C1R;
290     table_c1->fn_2d[CV_64F] = (void*)icvIntegralImage_64f_C1R;
291 
292     table_cn->fn_2d[CV_8U] = (void*)icvIntegralImage_8u64f_CnR;
293     table_cn->fn_2d[CV_32F] = (void*)icvIntegralImage_32f64f_CnR;
294     table_cn->fn_2d[CV_64F] = (void*)icvIntegralImage_64f_CnR;
295 }
296 
297 
298 typedef CvStatus (CV_STDCALL * CvIntegralImageFuncC1)(
299     const void* src, int srcstep, void* sum, int sumstep,
300     void* sqsum, int sqsumstep, void* tilted, int tiltedstep,
301     CvSize size );
302 
303 typedef CvStatus (CV_STDCALL * CvIntegralImageFuncCn)(
304     const void* src, int srcstep, void* sum, int sumstep,
305     void* sqsum, int sqsumstep, CvSize size, int cn );
306 
307 icvIntegral_8u32s_C1R_t icvIntegral_8u32s_C1R_p = 0;
308 icvSqrIntegral_8u32s64f_C1R_t icvSqrIntegral_8u32s64f_C1R_p = 0;
309 
310 CV_IMPL void
cvIntegral(const CvArr * image,CvArr * sumImage,CvArr * sumSqImage,CvArr * tiltedSumImage)311 cvIntegral( const CvArr* image, CvArr* sumImage,
312             CvArr* sumSqImage, CvArr* tiltedSumImage )
313 {
314     static CvFuncTable tab_c1, tab_cn;
315     static int inittab = 0;
316 
317     CV_FUNCNAME( "cvIntegralImage" );
318 
319     __BEGIN__;
320 
321     CvMat src_stub, *src = (CvMat*)image;
322     CvMat sum_stub, *sum = (CvMat*)sumImage;
323     CvMat sqsum_stub, *sqsum = (CvMat*)sumSqImage;
324     CvMat tilted_stub, *tilted = (CvMat*)tiltedSumImage;
325     int coi0 = 0, coi1 = 0, coi2 = 0, coi3 = 0;
326     int depth, cn;
327     int src_step, sum_step, sqsum_step, tilted_step;
328     CvIntegralImageFuncC1 func_c1 = 0;
329     CvIntegralImageFuncCn func_cn = 0;
330     CvSize size;
331 
332     if( !inittab )
333     {
334         icvInitIntegralImageTable( &tab_c1, &tab_cn );
335         inittab = 1;
336     }
337 
338     CV_CALL( src = cvGetMat( src, &src_stub, &coi0 ));
339     CV_CALL( sum = cvGetMat( sum, &sum_stub, &coi1 ));
340 
341     if( sum->width != src->width + 1 ||
342         sum->height != src->height + 1 )
343         CV_ERROR( CV_StsUnmatchedSizes, "" );
344 
345     if( (CV_MAT_DEPTH( sum->type ) != CV_64F &&
346         (CV_MAT_DEPTH( src->type ) != CV_8U ||
347          CV_MAT_DEPTH( sum->type ) != CV_32S )) ||
348         !CV_ARE_CNS_EQ( src, sum ))
349         CV_ERROR( CV_StsUnsupportedFormat,
350         "Sum array must have 64f type (or 32s type in case of 8u source array) "
351         "and the same number of channels as the source array" );
352 
353     if( sqsum )
354     {
355         CV_CALL( sqsum = cvGetMat( sqsum, &sqsum_stub, &coi2 ));
356         if( !CV_ARE_SIZES_EQ( sum, sqsum ) )
357             CV_ERROR( CV_StsUnmatchedSizes, "" );
358         if( CV_MAT_DEPTH( sqsum->type ) != CV_64F || !CV_ARE_CNS_EQ( src, sqsum ))
359             CV_ERROR( CV_StsUnsupportedFormat,
360                       "Squares sum array must be 64f "
361                       "and the same number of channels as the source array" );
362     }
363 
364     if( tilted )
365     {
366         if( !sqsum )
367             CV_ERROR( CV_StsNullPtr,
368             "Squared sum array must be passed if tilted sum array is passed" );
369 
370         CV_CALL( tilted = cvGetMat( tilted, &tilted_stub, &coi3 ));
371         if( !CV_ARE_SIZES_EQ( sum, tilted ) )
372             CV_ERROR( CV_StsUnmatchedSizes, "" );
373         if( !CV_ARE_TYPES_EQ( sum, tilted ) )
374             CV_ERROR( CV_StsUnmatchedFormats,
375                       "Sum and tilted sum must have the same types" );
376         if( CV_MAT_CN(tilted->type) != 1 )
377             CV_ERROR( CV_StsNotImplemented,
378                       "Tilted sum can not be computed for multi-channel arrays" );
379     }
380 
381     if( coi0 || coi1 || coi2 || coi3 )
382         CV_ERROR( CV_BadCOI, "COI is not supported by the function" );
383 
384     depth = CV_MAT_DEPTH(src->type);
385     cn = CV_MAT_CN(src->type);
386 
387     if( CV_MAT_DEPTH( sum->type ) == CV_32S )
388     {
389         func_c1 = (CvIntegralImageFuncC1)icvIntegralImage_8u32s_C1R;
390         func_cn = (CvIntegralImageFuncCn)icvIntegralImage_8u32s_CnR;
391     }
392     else
393     {
394         func_c1 = (CvIntegralImageFuncC1)tab_c1.fn_2d[depth];
395         func_cn = (CvIntegralImageFuncCn)tab_cn.fn_2d[depth];
396         if( !func_c1 && !func_cn )
397             CV_ERROR( CV_StsUnsupportedFormat, "This source image format is unsupported" );
398     }
399 
400     size = cvGetMatSize(src);
401     src_step = src->step ? src->step : CV_STUB_STEP;
402     sum_step = sum->step ? sum->step : CV_STUB_STEP;
403     sqsum_step = !sqsum ? 0 : sqsum->step ? sqsum->step : CV_STUB_STEP;
404     tilted_step = !tilted ? 0 : tilted->step ? tilted->step : CV_STUB_STEP;
405 
406     if( cn == 1 )
407     {
408         if( depth == CV_8U && !tilted && CV_MAT_DEPTH(sum->type) == CV_32S )
409         {
410             if( !sqsum && icvIntegral_8u32s_C1R_p &&
411                 icvIntegral_8u32s_C1R_p( src->data.ptr, src_step,
412                             sum->data.i, sum_step, size, 0 ) >= 0 )
413                 EXIT;
414 
415             if( sqsum && icvSqrIntegral_8u32s64f_C1R_p &&
416                 icvSqrIntegral_8u32s64f_C1R_p( src->data.ptr, src_step, sum->data.i,
417                             sum_step, sqsum->data.db, sqsum_step, size, 0, 0 ) >= 0 )
418                 EXIT;
419         }
420 
421         IPPI_CALL( func_c1( src->data.ptr, src_step, sum->data.ptr, sum_step,
422                         sqsum ? sqsum->data.ptr : 0, sqsum_step,
423                         tilted ? tilted->data.ptr : 0, tilted_step, size ));
424     }
425     else
426     {
427         IPPI_CALL( func_cn( src->data.ptr, src_step, sum->data.ptr, sum_step,
428                         sqsum ? sqsum->data.ptr : 0, sqsum_step, size, cn ));
429     }
430 
431     __END__;
432 }
433 
434 
435 /* End of file. */
436