/***************************************************************************** * rotate.c : video rotation filter ***************************************************************************** * Copyright (C) 2000-2008 VLC authors and VideoLAN * $Id$ * * Authors: Antoine Cellerier * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; either version 2 of the License, or * (at your option) any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston MA 02110-1301, USA. *****************************************************************************/ /***************************************************************************** * Preamble *****************************************************************************/ #ifdef HAVE_CONFIG_H # include "config.h" #endif #include /* sin(), cos() */ #define VLC_MODULE_LICENSE VLC_LICENSE_GPL_2_PLUS #include #include #include #include #include #include #include "filter_picture.h" #include "../control/motionlib.h" /***************************************************************************** * Local prototypes *****************************************************************************/ static int Create ( vlc_object_t * ); static void Destroy ( vlc_object_t * ); static picture_t *Filter( filter_t *, picture_t * ); static int Mouse( filter_t *p_filter, vlc_mouse_t *p_mouse, const vlc_mouse_t *p_old, const vlc_mouse_t *p_new ); static picture_t *FilterPacked( filter_t *, picture_t * ); static int RotateCallback( vlc_object_t *p_this, char const *psz_var, vlc_value_t oldval, vlc_value_t newval, void *p_data ); #define ANGLE_TEXT N_("Angle in degrees") #define ANGLE_LONGTEXT N_("Angle in degrees (0 to 359)") #define MOTION_TEXT N_("Use motion sensors") #define MOTION_LONGTEXT N_("Use HDAPS, AMS, APPLESMC or UNIMOTION motion " \ "sensors to rotate the video") #define FILTER_PREFIX "rotate-" /***************************************************************************** * Module descriptor *****************************************************************************/ vlc_module_begin () set_description( N_("Rotate video filter") ) set_shortname( N_( "Rotate" )) set_capability( "video filter", 0 ) set_category( CAT_VIDEO ) set_subcategory( SUBCAT_VIDEO_VFILTER ) add_float( FILTER_PREFIX "angle", 30., ANGLE_TEXT, ANGLE_LONGTEXT, false ) add_bool( FILTER_PREFIX "use-motion", false, MOTION_TEXT, MOTION_LONGTEXT, false ) add_shortcut( "rotate" ) set_callbacks( Create, Destroy ) vlc_module_end () static const char *const ppsz_filter_options[] = { "angle", "use-motion", NULL }; /***************************************************************************** * filter_sys_t *****************************************************************************/ struct filter_sys_t { atomic_uint_fast32_t sincos; motion_sensors_t *p_motion; }; typedef union { uint32_t u; struct { int16_t sin; int16_t cos; }; } sincos_t; static void store_trigo( struct filter_sys_t *sys, float f_angle ) { sincos_t sincos; f_angle *= (float)(M_PI / 180.); /* degrees -> radians */ sincos.sin = lroundf(sinf(f_angle) * 4096.f); sincos.cos = lroundf(cosf(f_angle) * 4096.f); atomic_store(&sys->sincos, sincos.u); } static void fetch_trigo( struct filter_sys_t *sys, int *i_sin, int *i_cos ) { sincos_t sincos = { .u = atomic_load(&sys->sincos) }; *i_sin = sincos.sin; *i_cos = sincos.cos; } /***************************************************************************** * Create: allocates Distort video filter *****************************************************************************/ static int Create( vlc_object_t *p_this ) { filter_t *p_filter = (filter_t *)p_this; filter_sys_t *p_sys; if( p_filter->fmt_in.video.i_chroma != p_filter->fmt_out.video.i_chroma ) { msg_Err( p_filter, "Input and output chromas don't match" ); return VLC_EGENERIC; } switch( p_filter->fmt_in.video.i_chroma ) { CASE_PLANAR_YUV p_filter->pf_video_filter = Filter; break; CASE_PACKED_YUV_422 p_filter->pf_video_filter = FilterPacked; break; default: msg_Err( p_filter, "Unsupported input chroma (%4.4s)", (char*)&(p_filter->fmt_in.video.i_chroma) ); return VLC_EGENERIC; } /* Add mouse filter */ p_filter->pf_video_mouse = Mouse; /* Allocate structure */ p_filter->p_sys = malloc( sizeof( filter_sys_t ) ); if( p_filter->p_sys == NULL ) return VLC_ENOMEM; p_sys = p_filter->p_sys; config_ChainParse( p_filter, FILTER_PREFIX, ppsz_filter_options, p_filter->p_cfg ); if( var_InheritBool( p_filter, FILTER_PREFIX "use-motion" ) ) { p_sys->p_motion = motion_create( VLC_OBJECT( p_filter ) ); if( p_sys->p_motion == NULL ) { free( p_sys ); return VLC_EGENERIC; } } else { float f_angle = var_CreateGetFloatCommand( p_filter, FILTER_PREFIX "angle" ); store_trigo( p_sys, f_angle ); var_AddCallback( p_filter, FILTER_PREFIX "angle", RotateCallback, p_sys ); p_sys->p_motion = NULL; } return VLC_SUCCESS; } /***************************************************************************** * Destroy: destroy Distort filter *****************************************************************************/ static void Destroy( vlc_object_t *p_this ) { filter_t *p_filter = (filter_t *)p_this; filter_sys_t *p_sys = p_filter->p_sys; if( p_sys->p_motion != NULL ) motion_destroy( p_sys->p_motion ); else { var_DelCallback( p_filter, FILTER_PREFIX "angle", RotateCallback, p_sys ); } free( p_sys ); } /***************************************************************************** * *****************************************************************************/ static int Mouse( filter_t *p_filter, vlc_mouse_t *p_mouse, const vlc_mouse_t *p_old, const vlc_mouse_t *p_new ) { VLC_UNUSED( p_old ); const video_format_t *p_fmt = &p_filter->fmt_out.video; filter_sys_t *p_sys = p_filter->p_sys; *p_mouse = *p_new; if( p_sys->p_motion != NULL ) { int i_angle = motion_get_angle( p_sys->p_motion ); store_trigo( p_sys, i_angle / 20.f ); } int i_sin, i_cos; fetch_trigo( p_sys, &i_sin, &i_cos ); p_mouse->i_x = ( p_fmt->i_visible_width >> 1 ); p_mouse->i_y = ( p_fmt->i_visible_height >> 1 ); const int i_rx = ( p_new->i_x - p_mouse->i_x ); const int i_ry = ( p_new->i_y - p_mouse->i_y ); p_mouse->i_x += ( ( i_rx * i_cos - i_ry * i_sin )>> 12 ); p_mouse->i_y += ( ( i_rx * i_sin + i_ry * i_cos )>> 12 ); return VLC_SUCCESS; } /***************************************************************************** * *****************************************************************************/ static picture_t *Filter( filter_t *p_filter, picture_t *p_pic ) { picture_t *p_outpic; filter_sys_t *p_sys = p_filter->p_sys; if( !p_pic ) return NULL; p_outpic = filter_NewPicture( p_filter ); if( !p_outpic ) { picture_Release( p_pic ); return NULL; } if( p_sys->p_motion != NULL ) { int i_angle = motion_get_angle( p_sys->p_motion ); store_trigo( p_sys, i_angle / 20.f ); } int i_sin, i_cos; fetch_trigo( p_sys, &i_sin, &i_cos ); for( int i_plane = 0 ; i_plane < p_pic->i_planes ; i_plane++ ) { plane_t *p_srcp = &p_pic->p[i_plane]; plane_t *p_dstp = &p_outpic->p[i_plane]; const int i_visible_lines = p_srcp->i_visible_lines; const int i_visible_pitch = p_srcp->i_visible_pitch; const int i_aspect = __MAX( 1, ( i_visible_lines * p_pic->p[Y_PLANE].i_visible_pitch ) / ( p_pic->p[Y_PLANE].i_visible_lines * i_visible_pitch )); /* = 2 for U and V planes in YUV 4:2:2, = 1 otherwise */ const int i_line_center = i_visible_lines>>1; const int i_col_center = i_visible_pitch>>1; const uint8_t black_pixel = ( i_plane == Y_PLANE ) ? 0x00 : 0x80; const int i_line_next = i_cos / i_aspect -i_sin*i_visible_pitch; const int i_col_next = -i_sin / i_aspect -i_cos*i_visible_pitch; int i_line_orig0 = ( - i_cos * i_line_center / i_aspect - i_sin * i_col_center + (1<<11) ); int i_col_orig0 = i_sin * i_line_center / i_aspect - i_cos * i_col_center + (1<<11); for( int y = 0; y < i_visible_lines; y++) { uint8_t *p_out = &p_dstp->p_pixels[y * p_dstp->i_pitch]; for( int x = 0; x < i_visible_pitch; x++, p_out++ ) { const int i_line_orig = (i_line_orig0>>12)*i_aspect + i_line_center; const int i_col_orig = (i_col_orig0>>12) + i_col_center; const uint8_t *p_orig_offset = &p_srcp->p_pixels[i_line_orig * p_srcp->i_pitch + i_col_orig]; const uint8_t i_line_percent = (i_line_orig0>>4) & 255; const uint8_t i_col_percent = (i_col_orig0 >>4) & 255; if( -1 <= i_line_orig && i_line_orig < i_visible_lines && -1 <= i_col_orig && i_col_orig < i_visible_pitch ) { #define test 1 #undef test #ifdef test if( ( i_col_orig > i_visible_pitch/2 ) ) #endif { uint8_t i_curpix = black_pixel; uint8_t i_colpix = black_pixel; uint8_t i_linpix = black_pixel; uint8_t i_nexpix = black_pixel; if( ( 0 <= i_line_orig ) && ( 0 <= i_col_orig ) ) i_curpix = *p_orig_offset; p_orig_offset++; if( ( i_col_orig < i_visible_pitch - 1) && ( i_line_orig >= 0 ) ) i_colpix = *p_orig_offset; p_orig_offset += p_srcp->i_pitch; if( ( i_line_orig < i_visible_lines - 1) && ( i_col_orig < i_visible_pitch - 1) ) i_nexpix = *p_orig_offset; p_orig_offset--; if( ( i_line_orig < i_visible_lines - 1) && ( i_col_orig >= 0 ) ) i_linpix = *p_orig_offset; unsigned int temp = 0; temp+= i_curpix * (256 - i_line_percent) * ( 256 - i_col_percent ); temp+= i_linpix * i_line_percent * (256 - i_col_percent ); temp+= i_nexpix * ( i_col_percent) * ( i_line_percent); temp+= i_colpix * i_col_percent * (256 - i_line_percent ); *p_out = temp >> 16; } #ifdef test else if (i_col_orig == i_visible_pitch/2 ) { *p_out = black_pixel; } else *p_out = *p_orig_offset; #endif #undef test } else { *p_out = black_pixel; } i_line_orig0 += i_sin; i_col_orig0 += i_cos; } i_line_orig0 += i_line_next; i_col_orig0 += i_col_next; } } return CopyInfoAndRelease( p_outpic, p_pic ); } /***************************************************************************** * *****************************************************************************/ static picture_t *FilterPacked( filter_t *p_filter, picture_t *p_pic ) { picture_t *p_outpic; filter_sys_t *p_sys = p_filter->p_sys; if( !p_pic ) return NULL; int i_u_offset, i_v_offset, i_y_offset; if( GetPackedYuvOffsets( p_pic->format.i_chroma, &i_y_offset, &i_u_offset, &i_v_offset ) != VLC_SUCCESS ) { msg_Warn( p_filter, "Unsupported input chroma (%4.4s)", (char*)&(p_pic->format.i_chroma) ); picture_Release( p_pic ); return NULL; } p_outpic = filter_NewPicture( p_filter ); if( !p_outpic ) { picture_Release( p_pic ); return NULL; } const int i_visible_pitch = p_pic->p->i_visible_pitch>>1; /* In fact it's i_visible_pixels */ const int i_visible_lines = p_pic->p->i_visible_lines; const uint8_t *p_in = p_pic->p->p_pixels+i_y_offset; const uint8_t *p_in_u = p_pic->p->p_pixels+i_u_offset; const uint8_t *p_in_v = p_pic->p->p_pixels+i_v_offset; const int i_in_pitch = p_pic->p->i_pitch; uint8_t *p_out = p_outpic->p->p_pixels+i_y_offset; uint8_t *p_out_u = p_outpic->p->p_pixels+i_u_offset; uint8_t *p_out_v = p_outpic->p->p_pixels+i_v_offset; const int i_out_pitch = p_outpic->p->i_pitch; const int i_line_center = i_visible_lines>>1; const int i_col_center = i_visible_pitch>>1; if( p_sys->p_motion != NULL ) { int i_angle = motion_get_angle( p_sys->p_motion ); store_trigo( p_sys, i_angle / 20.f ); } int i_sin, i_cos; fetch_trigo( p_sys, &i_sin, &i_cos ); for( int i_line = 0; i_line < i_visible_lines; i_line++ ) { for( int i_col = 0; i_col < i_visible_pitch; i_col++ ) { int i_line_orig; int i_col_orig; /* Handle "1st Y", U and V */ i_line_orig = i_line_center + ( ( i_sin * ( i_col - i_col_center ) + i_cos * ( i_line - i_line_center ) )>>12 ); i_col_orig = i_col_center + ( ( i_cos * ( i_col - i_col_center ) - i_sin * ( i_line - i_line_center ) )>>12 ); if( 0 <= i_col_orig && i_col_orig < i_visible_pitch && 0 <= i_line_orig && i_line_orig < i_visible_lines ) { p_out[i_line*i_out_pitch+2*i_col] = p_in[i_line_orig*i_in_pitch+2*i_col_orig]; i_col_orig /= 2; p_out_u[i_line*i_out_pitch+2*i_col] = p_in_u[i_line_orig*i_in_pitch+4*i_col_orig]; p_out_v[i_line*i_out_pitch+2*i_col] = p_in_v[i_line_orig*i_in_pitch+4*i_col_orig]; } else { p_out[i_line*i_out_pitch+2*i_col] = 0x00; p_out_u[i_line*i_out_pitch+2*i_col] = 0x80; p_out_v[i_line*i_out_pitch+2*i_col] = 0x80; } /* Handle "2nd Y" */ i_col++; if( i_col >= i_visible_pitch ) break; i_line_orig = i_line_center + ( ( i_sin * ( i_col - i_col_center ) + i_cos * ( i_line - i_line_center ) )>>12 ); i_col_orig = i_col_center + ( ( i_cos * ( i_col - i_col_center ) - i_sin * ( i_line - i_line_center ) )>>12 ); if( 0 <= i_col_orig && i_col_orig < i_visible_pitch && 0 <= i_line_orig && i_line_orig < i_visible_lines ) { p_out[i_line*i_out_pitch+2*i_col] = p_in[i_line_orig*i_in_pitch+2*i_col_orig]; } else { p_out[i_line*i_out_pitch+2*i_col] = 0x00; } } } return CopyInfoAndRelease( p_outpic, p_pic ); } /***************************************************************************** * Angle modification callback. *****************************************************************************/ static int RotateCallback( vlc_object_t *p_this, char const *psz_var, vlc_value_t oldval, vlc_value_t newval, void *data ) { filter_sys_t *p_sys = data; store_trigo( p_sys, newval.f_float ); (void) p_this; (void) psz_var; (void) oldval; return VLC_SUCCESS; }