1 /*****************************************************************************
2 * motiondetec.c : Second version of a motion detection plugin.
3 *****************************************************************************
4 * Copyright (C) 2000-2006 the VideoLAN team
7 * Authors: Antoine Cellerier <dionoea -at- videolan -dot- org>
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License as published by
11 * the Free Software Foundation; either version 2 of the License, or
12 * (at your option) any later version.
14 * This program is distributed in the hope that it will be useful,
15 * but WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
17 * GNU General Public License for more details.
19 * You should have received a copy of the GNU General Public License
20 * along with this program; if not, write to the Free Software
21 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston MA 02110-1301, USA.
22 *****************************************************************************/
24 /*****************************************************************************
26 *****************************************************************************/
27 #include <stdlib.h> /* malloc(), free() */
30 #include <math.h> /* sin(), cos() */
36 #include "vlc_filter.h"
38 /*****************************************************************************
40 *****************************************************************************/
41 static int Create ( vlc_object_t * );
42 static void Destroy ( vlc_object_t * );
44 static picture_t *Filter( filter_t *, picture_t * );
45 static void GaussianConvolution( uint32_t *, uint32_t *, int, int, int );
47 /*****************************************************************************
49 *****************************************************************************/
51 #define FILTER_PREFIX "motiondetect-"
54 set_description( _("Motion detect video filter") );
55 set_shortname( _( "Motion Detect" ));
56 set_capability( "video filter2", 0 );
57 set_category( CAT_VIDEO );
58 set_subcategory( SUBCAT_VIDEO_VFILTER );
60 add_shortcut( "motion" );
61 set_callbacks( Create, Destroy );
65 static const char *ppsz_filter_options[] = {
80 /*****************************************************************************
82 *****************************************************************************/
83 static int Create( vlc_object_t *p_this )
85 filter_t *p_filter = (filter_t *)p_this;
87 /* Allocate structure */
88 p_filter->p_sys = malloc( sizeof( filter_sys_t ) );
89 if( p_filter->p_sys == NULL )
91 msg_Err( p_filter, "out of memory" );
95 p_filter->pf_video_filter = Filter;
97 p_filter->p_sys->p_oldpix = NULL;
98 p_filter->p_sys->p_buf = NULL;
101 config_ChainParse( p_filter, FILTER_PREFIX, ppsz_filter_options,
104 vlc_mutex_init( p_filter, &p_filter->p_sys->lock );
109 /*****************************************************************************
111 *****************************************************************************/
112 static void Destroy( vlc_object_t *p_this )
114 filter_t *p_filter = (filter_t *)p_this;
116 free( p_filter->p_sys->p_oldpix );
117 free( p_filter->p_sys->p_buf );
119 vlc_mutex_destroy( &p_filter->p_sys->lock );
121 free( p_filter->p_sys );
124 /*****************************************************************************
126 *****************************************************************************/
127 static picture_t *Filter( filter_t *p_filter, picture_t *p_inpic )
130 filter_sys_t *p_sys = p_filter->p_sys;
132 const uint8_t *p_inpix = p_inpic->p[Y_PLANE].p_pixels;
133 const int i_src_pitch = p_inpic->p[Y_PLANE].i_pitch;
134 const int i_src_visible = p_inpic->p[Y_PLANE].i_visible_pitch;
135 const int i_num_lines = p_inpic->p[Y_PLANE].i_visible_lines;
137 const uint8_t *p_inpix_u = p_inpic->p[U_PLANE].p_pixels;
138 const uint8_t *p_inpix_v = p_inpic->p[V_PLANE].p_pixels;
139 const int i_src_pitch_u = p_inpic->p[U_PLANE].i_pitch;
140 const int i_src_visible_u = p_inpic->p[U_PLANE].i_visible_pitch;
141 const int i_num_lines_u = p_inpic->p[U_PLANE].i_visible_lines;
153 if( !p_inpic ) return NULL;
155 p_outpic = p_filter->pf_vout_buffer_new( p_filter );
158 msg_Warn( p_filter, "can't get output picture" );
159 if( p_inpic->pf_release )
160 p_inpic->pf_release( p_inpic );
164 p_outpix = p_outpic->p[Y_PLANE].p_pixels;
166 p_filter->p_libvlc->pf_memset( p_outpic->p[U_PLANE].p_pixels, 0x80,
167 p_inpic->p[U_PLANE].i_pitch * p_inpic->p[U_PLANE].i_visible_lines );
168 p_filter->p_libvlc->pf_memset( p_outpic->p[V_PLANE].p_pixels, 0x80,
169 p_inpic->p[V_PLANE].i_pitch * p_inpic->p[V_PLANE].i_visible_lines );
171 p_filter->p_libvlc->pf_memcpy( p_outpic->p[U_PLANE].p_pixels,
172 p_inpic->p[U_PLANE].p_pixels,
173 p_inpic->p[U_PLANE].i_pitch * p_inpic->p[U_PLANE].i_visible_lines );
174 p_filter->p_libvlc->pf_memcpy( p_outpic->p[V_PLANE].p_pixels,
175 p_inpic->p[V_PLANE].p_pixels,
176 p_inpic->p[V_PLANE].i_pitch * p_inpic->p[V_PLANE].i_visible_lines );
179 if( !p_sys->p_oldpix || !p_sys->p_buf )
181 free( p_sys->p_oldpix );
182 free( p_sys->p_buf );
183 p_sys->p_oldpix = malloc( i_src_pitch * i_num_lines );
184 p_sys->p_oldpix_u = malloc( i_src_pitch_u * i_num_lines_u );
185 p_sys->p_oldpix_v = malloc( i_src_pitch_u * i_num_lines_u );
186 p_sys->p_buf = malloc( sizeof( uint32_t ) * i_src_pitch * i_num_lines );
187 p_sys->p_buf2 = malloc( sizeof( uint32_t ) * i_src_pitch * i_num_lines);
190 p_oldpix = p_sys->p_oldpix;
191 p_oldpix_u = p_sys->p_oldpix_u;
192 p_oldpix_v = p_sys->p_oldpix_v;
193 p_buf = p_sys->p_buf;
194 p_buf2 = p_sys->p_buf2;
196 vlc_mutex_lock( &p_filter->p_sys->lock );
201 for( i = 0; i < i_src_pitch * i_num_lines; i++ )
203 if( p_inpix[i] > p_oldpix[i] )
205 p_buf2[i] = p_inpix[i] - p_oldpix[i];
209 p_buf2[i] = p_oldpix[i] - p_inpix[i];
215 switch( p_inpic->format.i_chroma )
217 case VLC_FOURCC('I','4','2','0'):
218 case VLC_FOURCC('I','Y','U','V'):
219 case VLC_FOURCC('J','4','2','0'):
220 case VLC_FOURCC('Y','V','1','2'):
224 case VLC_FOURCC('I','4','2','2'):
225 case VLC_FOURCC('J','4','2','2'):
231 msg_Warn( p_filter, "Not taking chroma into account" );
237 for( line = 0; line < i_num_lines_u; line++ )
239 for( col = 0; col < i_src_pitch_u; col ++ )
242 i = line * i_src_pitch_u + col;
243 if( p_inpix_u[i] > p_oldpix_u[i] )
245 diff = p_inpix_u[i] - p_oldpix_u[i];
249 diff = p_oldpix_u[i] - p_inpix_u[i];
254 p_buf2[2*line*i_src_pitch+2*col] += diff;
255 p_buf2[2*line*i_src_pitch+2*col+1] += diff;
256 p_buf2[(2*line+1)*i_src_pitch+2*col] += diff;
257 p_buf2[(2*line+1)*i_src_pitch+2*col+1] += diff;
261 p_buf2[line*i_src_pitch+2*col] += diff;
262 p_buf2[line*i_src_pitch+2*col+1] += diff;
270 * Apply some smoothing to remove noise
273 GaussianConvolution( p_buf2, p_buf, i_src_pitch, i_num_lines, i_src_visible );
276 uint32_t *pouet = p_buf2;
281 * Copy luminance plane
283 for( i = 0; i < i_src_pitch * i_num_lines; i++ )
285 /*if( p_buf[i] > 25 )
289 else// if( p_buf[i] > 15 )*/
291 p_outpix[i] = p_inpix[i];
300 * Label the shapes ans build the labels dependencies list
304 int color_x_min[5000];
305 int color_x_max[5000];
306 int color_y_min[5000];
307 int color_y_max[5000];
309 for( j = 0; j < i_src_pitch; j++ )
312 p_buf[(i_num_lines-1)*i_src_pitch+j] = 0;
314 for( i = 1; i < i_num_lines-1; i++ )
316 p_buf[i*i_src_pitch] = 0;
317 for( j = 1; j < i_src_pitch-1; j++ )
319 if( p_buf[i*i_src_pitch+j] > 15 )
321 if( p_buf[(i-1)*i_src_pitch+j-1] )
323 p_buf[i*i_src_pitch+j] = p_buf[(i-1)*i_src_pitch+j-1];
325 else if( p_buf[(i-1)*i_src_pitch+j] )
326 p_buf[i*i_src_pitch+j] = p_buf[(i-1)*i_src_pitch+j];
327 else if( p_buf[i*i_src_pitch+j-1] )
328 p_buf[i*i_src_pitch+j] = p_buf[i*i_src_pitch+j-1];
331 p_buf[i*i_src_pitch+j] = last;
336 if( p_buf[A] && p_buf[A] != p_buf[i*i_src_pitch+j] ) \
338 if( p_buf[A] < p_buf[i*i_src_pitch+j] ) \
339 colors[p_buf[i*i_src_pitch+j]] = p_buf[A]; \
341 colors[p_buf[A]] = p_buf[i*i_src_pitch+j]; \
343 CHECK( i*i_src_pitch+j-1 );
344 CHECK( (i-1)*i_src_pitch+j-1 );
345 CHECK( (i-1)*i_src_pitch+j );
346 CHECK( (i-1)*i_src_pitch+j+1 );
350 p_buf[i*i_src_pitch+j] = 0;
353 p_buf[i*i_src_pitch+j] = 0;
357 * Initialise empty rectangle list
359 for( i = 1; i < last; i++ )
368 * Compute rectangle coordinates
370 for( i = 0; i < i_src_pitch * i_num_lines; i++ )
374 while( colors[p_buf[i]] != p_buf[i] )
375 p_buf[i] = colors[p_buf[i]];
376 //p_outpix[i] = /*(p_buf[i]%2) */ 0xff;
377 if( color_x_min[p_buf[i]] == -1 )
379 color_x_min[p_buf[i]] =
380 color_x_max[p_buf[i]] = i % i_src_pitch;
381 color_y_min[p_buf[i]] =
382 color_y_max[p_buf[i]] = i / i_src_pitch;
386 int x = i % i_src_pitch, y = i / i_src_pitch;
387 if( x < color_x_min[p_buf[i]] )
388 color_x_min[p_buf[i]] = x;
389 if( x > color_x_max[p_buf[i]] )
390 color_x_max[p_buf[i]] = x;
391 if( y < color_y_min[p_buf[i]] )
392 color_y_min[p_buf[i]] = y;
393 if( y > color_y_max[p_buf[i]] )
394 color_y_max[p_buf[i]] = y;
400 * Merge overlaping rectangles
402 for( i = 1; i < last; i++ )
404 if( colors[i] != i ) continue;
405 if( color_x_min[i] == -1 ) continue;
406 for( j = i+1; j < last; j++ )
408 if( colors[j] != j ) continue;
409 if( color_x_min[j] == -1 ) continue;
410 #define max( a, b ) ( a > b ? a : b )
411 #define min( a, b ) ( a < b ? a : b )
412 if( max( color_x_min[i], color_x_min[j] ) < min( color_x_max[i], color_x_max[j] ) && max( color_y_min[i], color_y_min[j] ) < min( color_y_max[i], color_y_max[j] ) )
414 color_x_min[i] = min( color_x_min[i], color_x_min[j] );
415 color_x_max[i] = max( color_x_max[i], color_x_max[j] );
416 color_y_min[i] = min( color_y_min[i], color_y_min[j] );
417 color_y_max[i] = max( color_y_max[i], color_y_max[j] );
425 * Count final number of shapes
426 * Draw rectangles (there can be more than 1 moving shape in 1 rectangle)
429 for( i = 1; i < last; i++ )
431 if( colors[i] == i && color_x_min[i] != -1 )
433 if( ( color_y_max[i] - color_y_min[i] ) * ( color_x_max[i] - color_x_min[i] ) < 16 ) continue;
438 for( x = color_x_min[i]; x <= color_x_max[i]; x++ )
440 p_outpix[y*i_src_pitch+x] = 0xff;
443 for( x = color_x_min[i]; x <= color_x_max[i]; x++ )
445 p_outpix[y*i_src_pitch+x] = 0xff;
448 for( y = color_y_min[i]; y <= color_y_max[i]; y++ )
450 p_outpix[y*i_src_pitch+x] = 0xff;
453 for( y = color_y_min[i]; y <= color_y_max[i]; y++ )
455 p_outpix[y*i_src_pitch+x] = 0xff;
458 for( x = color_x_min[i]; x <= color_x_max[i]; x++ )
460 for( y = color_y_min[i]; y <= color_y_max[i]; y++ )
462 p_outpix[y*i_src_pitch+x] = 0x0;
463 //p_inpix[y*i_src_pitch+x];
469 printf("counted %d moving shapes\n", j);
472 * We're done. Lets keep a copy of the Y plane
474 p_filter->p_libvlc->pf_memcpy( p_oldpix, p_inpix,
475 i_src_pitch * i_num_lines );
476 p_filter->p_libvlc->pf_memcpy( p_oldpix_u, p_inpix_u,
477 i_src_pitch_u * i_num_lines_u );
478 p_filter->p_libvlc->pf_memcpy( p_oldpix_v, p_inpix_v,
479 i_src_pitch_u * i_num_lines_u );
481 vlc_mutex_unlock( &p_filter->p_sys->lock );
484 p_outpic->date = p_inpic->date;
485 p_outpic->b_force = p_inpic->b_force;
486 p_outpic->i_nb_fields = p_inpic->i_nb_fields;
487 p_outpic->b_progressive = p_inpic->b_progressive;
488 p_outpic->b_top_field_first = p_inpic->b_top_field_first;
490 if( p_inpic->pf_release )
491 p_inpic->pf_release( p_inpic );
497 /*****************************************************************************
498 * Gaussian Convolution
499 *****************************************************************************
500 * Gaussian convolution ( sigma == 1.4 )
502 * | 2 4 5 4 2 | | 2 4 4 4 2 |
503 * | 4 9 12 9 4 | | 4 8 12 8 4 |
504 * | 5 12 15 12 5 | ~ | 4 12 16 12 4 |
505 * | 4 9 12 9 4 | | 4 8 12 8 4 |
506 * | 2 4 5 4 2 | | 2 4 4 4 2 |
507 *****************************************************************************/
508 static void GaussianConvolution( uint32_t *p_inpix, uint32_t *p_smooth,
509 int i_src_pitch, int i_num_lines,
512 /* const uint8_t *p_inpix = p_inpic->p[Y_PLANE].p_pixels;
513 const int i_src_pitch = p_inpic->p[Y_PLANE].i_pitch;
514 const int i_src_visible = p_inpic->p[Y_PLANE].i_visible_pitch;
515 const int i_num_lines = p_inpic->p[Y_PLANE].i_visible_lines;*/
518 for( y = 2; y < i_num_lines - 2; y++ )
520 for( x = 2; x < i_src_visible - 2; x++ )
522 p_smooth[y*i_src_visible+x] = (uint32_t)(
524 ( p_inpix[(y-2)*i_src_pitch+x-2] )
525 + ((p_inpix[(y-2)*i_src_pitch+x-1]
526 + p_inpix[(y-2)*i_src_pitch+x]
527 + p_inpix[(y-2)*i_src_pitch+x+1])<<1 )
528 + ( p_inpix[(y-2)*i_src_pitch+x+2] )
530 + ((p_inpix[(y-1)*i_src_pitch+x-2]
531 + ( p_inpix[(y-1)*i_src_pitch+x-1]<<1 )
532 + ( p_inpix[(y-1)*i_src_pitch+x]*3 )
533 + ( p_inpix[(y-1)*i_src_pitch+x+1]<<1 )
534 + p_inpix[(y-1)*i_src_pitch+x+2]
536 + p_inpix[y*i_src_pitch+x-2]
537 + ( p_inpix[y*i_src_pitch+x-1]*3 )
538 + ( p_inpix[y*i_src_pitch+x]<<2 )
539 + ( p_inpix[y*i_src_pitch+x+1]*3 )
540 + p_inpix[y*i_src_pitch+x+2]
542 + p_inpix[(y+1)*i_src_pitch+x-2]
543 + ( p_inpix[(y+1)*i_src_pitch+x-1]<<1 )
544 + ( p_inpix[(y+1)*i_src_pitch+x]*3 )
545 + ( p_inpix[(y+1)*i_src_pitch+x+1]<<1 )
546 + p_inpix[(y+1)*i_src_pitch+x+2] )<<1 )
548 + ( p_inpix[(y+2)*i_src_pitch+x-2] )
549 + ((p_inpix[(y+2)*i_src_pitch+x-1]
550 + p_inpix[(y+2)*i_src_pitch+x]
551 + p_inpix[(y+2)*i_src_pitch+x+1])<<1 )
552 + ( p_inpix[(y+2)*i_src_pitch+x+2] )