laplace.cpp
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/laplace.h>
00025
00026 #include <core/exception.h>
00027
00028 #include <ippi.h>
00029 #include <cmath>
00030 #include <cstdlib>
00031
00032 namespace firevision {
00033 #if 0
00034 }
00035 #endif
00036
00037
00038
00039
00040
00041
00042
00043
00044 FilterLaplace::FilterLaplace()
00045 : Filter("FilterLaplace")
00046 {
00047 kernel = NULL;
00048 }
00049
00050
00051
00052
00053
00054
00055
00056 FilterLaplace::FilterLaplace(float sigma, unsigned int size, float scale)
00057 : Filter("FilterLaplace")
00058 {
00059 kernel_size = size;
00060 kernel = (int *)malloc( size * size * sizeof(int) );
00061 calculate_kernel( kernel, sigma, size, scale );
00062 }
00063
00064
00065
00066 FilterLaplace::~FilterLaplace()
00067 {
00068 if ( kernel != NULL ) {
00069 free( kernel );
00070 }
00071 }
00072
00073
00074 void
00075 FilterLaplace::apply()
00076 {
00077 IppiSize size;
00078 size.width = src_roi[0]->width - kernel_size;
00079 size.height = src_roi[0]->height - kernel_size;
00080
00081 IppStatus status;
00082
00083 if ( kernel == NULL ) {
00084
00085 status = ippiFilterLaplace_8u_C1R( src[0] + (src_roi[0]->start.y * src_roi[0]->line_step) + (src_roi[0]->start.x * src_roi[0]->pixel_step), src_roi[0]->line_step,
00086 dst + (dst_roi->start.y * dst_roi->line_step) + (dst_roi->start.x * dst_roi->pixel_step), dst_roi->line_step,
00087 size, ippMskSize5x5 );
00088 } else {
00089 IppiSize ksize = { kernel_size, kernel_size };
00090 IppiPoint kanchor = { (kernel_size + 1) / 2, (kernel_size + 1) / 2 };
00091
00092
00093
00094
00095
00096
00097
00098 status = ippiFilter_8u_C1R( src[0] + ((src_roi[0]->start.y + kernel_size / 2) * src_roi[0]->line_step) + ((src_roi[0]->start.x + kernel_size / 2) * src_roi[0]->pixel_step), src_roi[0]->line_step,
00099 dst + ((dst_roi->start.y + kernel_size / 2) * dst_roi->line_step) + ((dst_roi->start.x + kernel_size / 2) * dst_roi->pixel_step), dst_roi->line_step,
00100 size, kernel, ksize, kanchor, 1 );
00101
00102 }
00103
00104 if ( status != ippStsNoErr ) {
00105 throw fawkes::Exception("Laplace filter failed with %i\n", status);
00106 }
00107
00108
00109
00110
00111
00112
00113
00114
00115
00116
00117
00118
00119
00120
00121
00122
00123
00124
00125
00126
00127
00128
00129
00130
00131 }
00132
00133
00134
00135
00136
00137
00138
00139
00140
00141
00142
00143
00144
00145
00146
00147 void
00148 FilterLaplace::calculate_kernel(int *kernel, float sigma, unsigned int size, float scale)
00149 {
00150
00151
00152
00153
00154
00155
00156
00157
00158
00159
00160 for (int h = (-(int)(size / 2)); h <= (int)((size - 1) / 2); ++h) {
00161 for (int w = (-(int)(size / 2)); w <= (int)((size - 1) / 2); ++w) {
00162
00163
00164 int v = (int)roundf( - 1/( M_PI * sigma * sigma * sigma * sigma ) *
00165 ( 1 - ( (w*w + h*h) / (2 * sigma * sigma) ) )
00166 * exp( -( (w*w + h*h) / (2 * sigma * sigma) )) * scale );
00167
00168 kernel[ (h + (size / 2)) * size + (w + (size / 2)) ] = v;
00169 }
00170
00171 }
00172
00173
00174
00175
00176
00177
00178
00179
00180
00181
00182 }
00183
00184 }