00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022
00023
00024 #include <filters/min.h>
00025
00026 #include <core/exceptions/software.h>
00027 #include <fvutils/color/yuv.h>
00028 #include <cstddef>
00029
00030 using namespace fawkes;
00031
00032 namespace firevision {
00033 #if 0
00034 }
00035 #endif
00036
00037
00038
00039
00040
00041
00042
00043 FilterMin::FilterMin()
00044 : Filter("FilterMin", 2)
00045 {
00046 }
00047
00048
00049 void
00050 FilterMin::apply()
00051 {
00052 if ( src[0] == NULL ) throw NullPointerException("FilterInvert: src buffer 0 is NULL");
00053 if ( src[1] == NULL ) throw NullPointerException("FilterInvert: src buffer 1 is NULL");
00054 if ( src_roi[0] == NULL ) throw NullPointerException("FilterInvert: src ROI 0 is NULL");
00055 if ( src_roi[1] == NULL ) throw NullPointerException("FilterInvert: src ROI 1 is NULL");
00056
00057 register unsigned int h = 0;
00058 register unsigned int w = 0;
00059
00060
00061 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);
00062
00063 register unsigned char *bup = YUV422_PLANAR_U_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 register unsigned char *bvp = YUV422_PLANAR_V_PLANE(src[0], src_roi[0]->image_width, src_roi[0]->image_height)
00067 + ((src_roi[0]->start.y * src_roi[0]->line_step) / 2 + (src_roi[0]->start.x * src_roi[0]->pixel_step) / 2);
00068
00069
00070
00071 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);
00072
00073 register unsigned char *fup = YUV422_PLANAR_U_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 register unsigned char *fvp = YUV422_PLANAR_V_PLANE(src[1], src_roi[1]->image_width, src_roi[1]->image_height)
00077 + ((src_roi[1]->start.y * src_roi[1]->line_step) / 2 + (src_roi[1]->start.x * src_roi[1]->pixel_step) / 2);
00078
00079
00080
00081 register unsigned char *dyp = dst + (dst_roi->start.y * dst_roi->line_step) + (dst_roi->start.x * dst_roi->pixel_step);
00082
00083 register unsigned char *dup = YUV422_PLANAR_U_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 register unsigned char *dvp = YUV422_PLANAR_V_PLANE(dst, dst_roi->image_width, dst_roi->image_height)
00087 + ((dst_roi->start.y * dst_roi->line_step) / 2 + (dst_roi->start.x * dst_roi->pixel_step) / 2);
00088
00089
00090 unsigned char *lbyp = byp;
00091 unsigned char *lbup = fup;
00092 unsigned char *lbvp = fvp;
00093 unsigned char *lfyp = fyp;
00094 unsigned char *lfup = fup;
00095 unsigned char *lfvp = fvp;
00096 unsigned char *ldyp = dyp;
00097 unsigned char *ldup = dup;
00098 unsigned char *ldvp = dvp;
00099
00100 unsigned char u1, u2, v1, v2;
00101
00102 for (h = 0; (h < src_roi[1]->height) && (h < dst_roi->height); ++h) {
00103 for (w = 0; (w < src_roi[1]->width) && (w < dst_roi->width); w += 2) {
00104 if ( *byp < *fyp ) {
00105 *dyp++ = *byp;
00106 u1 = *bup;
00107 v1 = *bvp;
00108 } else {
00109 *dyp++ = *fyp;
00110 u1 = *fup;
00111 v1 = *fvp;
00112 }
00113 ++byp;
00114 ++fyp;
00115
00116 if ( *byp < *fyp ) {
00117 *dyp++ = *byp;
00118 u2 = *bup;
00119 v2 = *bvp;
00120 } else {
00121 *dyp++ = *fyp;
00122 u2 = *fup;
00123 v2 = *fvp;
00124 }
00125 ++byp;
00126 ++fyp;
00127
00128 *dup++ = (u1 + u2) / 2;
00129 *dvp++ = (v1 + v2) / 2;
00130
00131 ++bup;
00132 ++bvp;
00133 ++fup;
00134 ++fvp;
00135 }
00136
00137 lbyp += src_roi[0]->line_step;
00138 lbup += src_roi[0]->line_step / 2;
00139 lbvp += src_roi[0]->line_step / 2;
00140 lfyp += src_roi[1]->line_step;
00141 lfup += src_roi[1]->line_step / 2;
00142 lfvp += src_roi[1]->line_step / 2;
00143 ldyp += dst_roi->line_step;
00144 ldup += dst_roi->line_step / 2;
00145 ldvp += dst_roi->line_step / 2;
00146 byp = lbyp;
00147 bup = lbup;
00148 bvp = lbvp;
00149 fyp = lfyp;
00150 fup = lfup;
00151 fvp = lfvp;
00152 dyp = ldyp;
00153 dup = ldup;
00154 dvp = ldvp;
00155 }
00156
00157 }
00158
00159 }