Fawkes API Fawkes Development Version
|
00001 00002 /*************************************************************************** 00003 * difference.cpp - implementation of difference intensity filter 00004 * 00005 * Created: Sun Jun 25 23:07:35 2006 (on train to Ac, father in hospital) 00006 * Copyright 2005-2007 Tim Niemueller [www.niemueller.de] 00007 * 00008 ****************************************************************************/ 00009 00010 /* This program is free software; you can redistribute it and/or modify 00011 * it under the terms of the GNU General Public License as published by 00012 * the Free Software Foundation; either version 2 of the License, or 00013 * (at your option) any later version. A runtime exception applies to 00014 * this software (see LICENSE.GPL_WRE file mentioned below for details). 00015 * 00016 * This program is distributed in the hope that it will be useful, 00017 * but WITHOUT ANY WARRANTY; without even the implied warranty of 00018 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 00019 * GNU Library General Public License for more details. 00020 * 00021 * Read the full text in the LICENSE.GPL_WRE file in the doc directory. 00022 */ 00023 00024 #include <filters/difference.h> 00025 00026 #include <fvutils/color/yuv.h> 00027 #include <cstddef> 00028 00029 namespace firevision { 00030 #if 0 /* just to make Emacs auto-indent happy */ 00031 } 00032 #endif 00033 00034 /** @class FilterDifference <filters/difference.h> 00035 * Calculates the difference of two images. 00036 */ 00037 00038 /** Constructor. */ 00039 FilterDifference::FilterDifference() 00040 : Filter("FilterDifference", 2) 00041 { 00042 } 00043 00044 00045 void 00046 FilterDifference::apply() 00047 { 00048 if ( src[0] == NULL ) return; 00049 if ( src[1] == NULL ) return; 00050 if ( src_roi[0] == NULL ) return; 00051 if ( src_roi[1] == NULL ) return; 00052 00053 register unsigned int h = 0; 00054 register unsigned int w = 0; 00055 00056 00057 // y-plane 00058 register unsigned char *byp = src[0] + (src_roi[0]->start.y * src_roi[0]->line_step) + (src_roi[0]->start.x * src_roi[0]->pixel_step); 00059 // u-plane 00060 register unsigned char *bup = YUV422_PLANAR_U_PLANE(src[0], src_roi[0]->image_width, src_roi[0]->image_height) 00061 + ((src_roi[0]->start.y * src_roi[0]->line_step) / 2 + (src_roi[0]->start.x * src_roi[0]->pixel_step) / 2) ; 00062 // v-plane 00063 register unsigned char *bvp = YUV422_PLANAR_V_PLANE(src[0], src_roi[0]->image_width, src_roi[0]->image_height) 00064 + ((src_roi[0]->start.y * src_roi[0]->line_step) / 2 + (src_roi[0]->start.x * src_roi[0]->pixel_step) / 2); 00065 00066 00067 // y-plane 00068 register unsigned char *fyp = src[1] + (src_roi[1]->start.y * src_roi[1]->line_step) + (src_roi[1]->start.x * src_roi[1]->pixel_step); 00069 // u-plane 00070 register unsigned char *fup = YUV422_PLANAR_U_PLANE(src[1], src_roi[1]->image_width, src_roi[1]->image_height) 00071 + ((src_roi[1]->start.y * src_roi[1]->line_step) / 2 + (src_roi[1]->start.x * src_roi[1]->pixel_step) / 2) ; 00072 // v-plane 00073 register unsigned char *fvp = YUV422_PLANAR_V_PLANE(src[1], src_roi[1]->image_width, src_roi[1]->image_height) 00074 + ((src_roi[1]->start.y * src_roi[1]->line_step) / 2 + (src_roi[1]->start.x * src_roi[1]->pixel_step) / 2); 00075 00076 00077 // destination y-plane 00078 register unsigned char *dyp = dst + (dst_roi->start.y * dst_roi->line_step) + (dst_roi->start.x * dst_roi->pixel_step); 00079 // destination u-plane 00080 register unsigned char *dup = YUV422_PLANAR_U_PLANE(dst, dst_roi->image_width, dst_roi->image_height) 00081 + ((dst_roi->start.y * dst_roi->line_step) / 2 + (dst_roi->start.x * dst_roi->pixel_step) / 2) ; 00082 // destination v-plane 00083 register unsigned char *dvp = YUV422_PLANAR_V_PLANE(dst, dst_roi->image_width, dst_roi->image_height) 00084 + ((dst_roi->start.y * dst_roi->line_step) / 2 + (dst_roi->start.x * dst_roi->pixel_step) / 2); 00085 00086 // line starts 00087 unsigned char *lbyp = byp; // y-plane 00088 unsigned char *lbup = fup; // u-plane 00089 unsigned char *lbvp = fvp; // v-plane 00090 unsigned char *lfyp = fyp; // y-plane 00091 unsigned char *lfup = fup; // u-plane 00092 unsigned char *lfvp = fvp; // v-plane 00093 unsigned char *ldyp = dyp; // destination y-plane 00094 unsigned char *ldup = dup; // destination u-plane 00095 unsigned char *ldvp = dvp; // destination v-plane 00096 00097 for (h = 0; (h < src_roi[1]->height) && (h < dst_roi->height); ++h) { 00098 for (w = 0; (w < src_roi[1]->width) && (w < dst_roi->width); w += 2) { 00099 *dyp++ = ((*byp - *fyp) < 0) ? 0 : (*byp - *fyp); 00100 ++byp; ++fyp; 00101 *dyp++ = ((*byp - *fyp) < 0) ? 0 : (*byp - *fyp); 00102 ++byp; ++fyp; 00103 00104 *dup++ = (*fup++ + *bup++) / 2; 00105 *dvp++ = (*fvp++ + *bvp++) / 2; 00106 } 00107 00108 lbyp += src_roi[0]->line_step; 00109 lbup += src_roi[0]->line_step / 2; 00110 lbvp += src_roi[0]->line_step / 2; 00111 lfyp += src_roi[1]->line_step; 00112 lfup += src_roi[1]->line_step / 2; 00113 lfvp += src_roi[1]->line_step / 2; 00114 ldyp += dst_roi->line_step; 00115 ldup += dst_roi->line_step / 2; 00116 ldvp += dst_roi->line_step / 2; 00117 byp = lbyp; 00118 bup = lbup; 00119 bvp = lbvp; 00120 fyp = lfyp; 00121 fup = lfup; 00122 fvp = lfvp; 00123 dyp = ldyp; 00124 dup = ldup; 00125 dvp = ldvp; 00126 } 00127 00128 } 00129 00130 } // end namespace firevision