modules/video_filter/rotate.c

   1 /*****************************************************************************
   2  * rotate.c : video rotation filter
   3  *****************************************************************************
   4  * Copyright (C) 2000-2008 the VideoLAN team
   5  * $Id$
   6  *
   7  * Authors: Antoine Cellerier <dionoea -at- videolan -dot- org>
   8  *
   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.
  13  *
  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.
  18  *
  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  *****************************************************************************/
  23
  24 /*****************************************************************************
  25  * Preamble
  26  *****************************************************************************/
  27
  28 #ifdef HAVE_CONFIG_H
  29 # include "config.h"
  30 #endif
  31
  32 #include <math.h>                                            /* sin(), cos() */
  33
  34 #include <vlc_common.h>
  35 #include <vlc_plugin.h>
  36
  37 #include <vlc_filter.h>
  38 #include "filter_picture.h"
  39
  40 /*****************************************************************************
  41  * Local prototypes
  42  *****************************************************************************/
  43 static int  Create    ( vlc_object_t * );
  44 static void Destroy   ( vlc_object_t * );
  45
  46 static picture_t *Filter( filter_t *, picture_t * );
  47 static picture_t *FilterPacked( filter_t *, picture_t * );
  48
  49 static int RotateCallback( vlc_object_t *p_this, char const *psz_var,
  50                            vlc_value_t oldval, vlc_value_t newval,
  51                            void *p_data );
  52
  53 static int PreciseRotateCallback( vlc_object_t *p_this, char const *psz_var,
  54                            vlc_value_t oldval, vlc_value_t newval,
  55                            void *p_data );
  56
  57 #define ANGLE_TEXT N_("Angle in degrees")
  58 #define ANGLE_LONGTEXT N_("Angle in degrees (0 to 359)")
  59
  60 #define FILTER_PREFIX "rotate-"
  61
  62 /*****************************************************************************
  63  * Module descriptor
  64  *****************************************************************************/
  65 vlc_module_begin ()
  66     set_description( N_("Rotate video filter") )
  67     set_shortname( N_( "Rotate" ))
  68     set_capability( "video filter2", 0 )
  69     set_category( CAT_VIDEO )
  70     set_subcategory( SUBCAT_VIDEO_VFILTER )
  71
  72     add_integer_with_range( FILTER_PREFIX "angle", 30, 0, 359,
  73         ANGLE_TEXT, ANGLE_LONGTEXT, false )
  74
  75     add_shortcut( "rotate" )
  76     set_callbacks( Create, Destroy )
  77 vlc_module_end ()
  78
  79 static const char *const ppsz_filter_options[] = {
  80     "angle", NULL
  81 };
  82
  83 /*****************************************************************************
  84  * filter_sys_t
  85  *****************************************************************************/
  86 struct filter_sys_t
  87 {
  88     vlc_spinlock_t lock;
  89     int            i_cos;
  90     int            i_sin;
  91 };
  92
  93 static inline void cache_trigo( int i_angle, int *i_sin, int *i_cos )
  94 {
  95     const double f_angle = (((double)i_angle)*M_PI)/1800.;
  96     *i_sin = (int)(sin( f_angle )*4096.);
  97     *i_cos = (int)(cos( f_angle )*4096.);
  98 }
  99
 100 /*****************************************************************************
 101  * Create: allocates Distort video filter
 102  *****************************************************************************/
 103 static int Create( vlc_object_t *p_this )
 104 {
 105     filter_t *p_filter = (filter_t *)p_this;
 106     filter_sys_t *p_sys;
 107
 108     if( p_filter->fmt_in.video.i_chroma != p_filter->fmt_out.video.i_chroma )
 109     {
 110         msg_Err( p_filter, "Input and output chromas don't match" );
 111         return VLC_EGENERIC;
 112     }
 113
 114     switch( p_filter->fmt_in.video.i_chroma )
 115     {
 116         CASE_PLANAR_YUV
 117             p_filter->pf_video_filter = Filter;
 118             break;
 119
 120         CASE_PACKED_YUV_422
 121             p_filter->pf_video_filter = FilterPacked;
 122             break;
 123
 124         default:
 125             msg_Err( p_filter, "Unsupported input chroma (%4.4s)",
 126                      (char*)&(p_filter->fmt_in.video.i_chroma) );
 127             return VLC_EGENERIC;
 128     }
 129
 130     /* Allocate structure */
 131     p_filter->p_sys = malloc( sizeof( filter_sys_t ) );
 132     if( p_filter->p_sys == NULL )
 133         return VLC_ENOMEM;
 134     p_sys = p_filter->p_sys;
 135
 136     config_ChainParse( p_filter, FILTER_PREFIX, ppsz_filter_options,
 137                        p_filter->p_cfg );
 138
 139     int i_angle = var_CreateGetIntegerCommand( p_filter,
 140                                                FILTER_PREFIX "angle" ) * 10;
 141     cache_trigo( i_angle, &p_sys->i_sin, &p_sys->i_cos );
 142     var_Create( p_filter, FILTER_PREFIX "deciangle",
 143                 VLC_VAR_INTEGER|VLC_VAR_ISCOMMAND );
 144     vlc_spin_init( &p_sys->lock );
 145     var_AddCallback( p_filter, FILTER_PREFIX "angle", RotateCallback, p_sys );
 146     var_AddCallback( p_filter, FILTER_PREFIX "deciangle",
 147                      PreciseRotateCallback, p_sys );
 148
 149     return VLC_SUCCESS;
 150 }
 151
 152 /*****************************************************************************
 153  * Destroy: destroy Distort filter
 154  *****************************************************************************/
 155 static void Destroy( vlc_object_t *p_this )
 156 {
 157     filter_t *p_filter = (filter_t *)p_this;
 158
 159     var_DelCallback( p_filter, FILTER_PREFIX "angle", RotateCallback, p_filter->p_sys );
 160     var_DelCallback( p_filter, FILTER_PREFIX "deciangle",
 161                      PreciseRotateCallback, p_filter->p_sys );
 162     vlc_spin_destroy( &p_filter->p_sys->lock );
 163     free( p_filter->p_sys );
 164 }
 165
 166 /*****************************************************************************
 167  *
 168  *****************************************************************************/
 169 static picture_t *Filter( filter_t *p_filter, picture_t *p_pic )
 170 {
 171     picture_t *p_outpic;
 172     filter_sys_t *p_sys = p_filter->p_sys;
 173
 174     if( !p_pic ) return NULL;
 175
 176     p_outpic = filter_NewPicture( p_filter );
 177     if( !p_outpic )
 178     {
 179         picture_Release( p_pic );
 180         return NULL;
 181     }
 182
 183     vlc_spin_lock( &p_sys->lock );
 184     const int i_sin = p_sys->i_sin;
 185     const int i_cos = p_sys->i_cos;
 186     vlc_spin_unlock( &p_sys->lock );
 187
 188     for( int i_plane = 0 ; i_plane < p_pic->i_planes ; i_plane++ )
 189     {
 190         plane_t *p_srcp = &p_pic->p[i_plane];
 191         plane_t *p_dstp = &p_outpic->p[i_plane];
 192
 193         const int i_visible_lines = p_srcp->i_visible_lines;
 194         const int i_visible_pitch = p_srcp->i_visible_pitch;
 195
 196         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 ));
 197         /* = 2 for U and V planes in YUV 4:2:2, = 1 otherwise */
 198
 199         const int i_line_center = i_visible_lines>>1;
 200         const int i_col_center  = i_visible_pitch>>1;
 201
 202         const uint8_t black_pixel = ( i_plane == Y_PLANE ) ? 0x00 : 0x80;
 203
 204         const int i_line_next =  i_cos / i_aspect -i_sin*i_visible_pitch;
 205         const int i_col_next  = -i_sin / i_aspect -i_cos*i_visible_pitch;
 206         int i_line_orig0 = ( - i_cos * i_line_center / i_aspect
 207                              - i_sin * i_col_center + (1<<11) );
 208         int i_col_orig0 =    i_sin * i_line_center / i_aspect
 209                            - i_cos * i_col_center + (1<<11);
 210         for( int y = 0; y < i_visible_lines; y++)
 211         {
 212             uint8_t *p_out = &p_dstp->p_pixels[y * p_dstp->i_pitch];
 213
 214             for( int x = 0; x < i_visible_pitch; x++, p_out++ )
 215             {
 216                 const int i_line_orig = (i_line_orig0>>12)*i_aspect + i_line_center;
 217                 const int i_col_orig  = (i_col_orig0>>12)  + i_col_center;
 218                 const uint8_t *p_orig_offset = &p_srcp->p_pixels[i_line_orig * p_srcp->i_pitch + i_col_orig];
 219                 const uint8_t i_line_percent = (i_line_orig0>>4) & 255;
 220                 const uint8_t i_col_percent  = (i_col_orig0 >>4) & 255;
 221
 222                 if(    -1 <= i_line_orig && i_line_orig < i_visible_lines
 223                     && -1 <= i_col_orig  && i_col_orig  < i_visible_pitch )
 224                 {
 225                 #define test 1
 226                 #undef test
 227                 #ifdef test
 228                     if( ( i_col_orig > i_visible_pitch/2 ) )
 229                 #endif
 230                     {
 231                         uint8_t i_curpix = black_pixel;
 232                         uint8_t i_colpix = black_pixel;
 233                         uint8_t i_linpix = black_pixel;
 234                         uint8_t i_nexpix = black_pixel;
 235                         if( ( 0 <= i_line_orig ) && ( 0 <= i_col_orig ) )
 236                             i_curpix = *p_orig_offset;
 237                         p_orig_offset++;
 238
 239                         if(  ( i_col_orig < i_visible_pitch - 1)
 240                              && ( i_line_orig >= 0 ) )
 241                             i_colpix = *p_orig_offset;
 242
 243                         p_orig_offset += p_srcp->i_pitch;
 244                         if( ( i_line_orig < i_visible_lines - 1)
 245                             && ( i_col_orig  < i_visible_pitch - 1) )
 246                             i_nexpix = *p_orig_offset;
 247
 248                         p_orig_offset--;
 249                         if(  ( i_line_orig < i_visible_lines - 1)
 250                              && ( i_col_orig >= 0 ) )
 251                             i_linpix = *p_orig_offset;
 252
 253                         unsigned int temp = 0;
 254                         temp+= i_curpix *
 255                             (256 - i_line_percent) * ( 256 - i_col_percent );
 256                         temp+= i_linpix *
 257                             i_line_percent * (256 - i_col_percent );
 258                         temp+= i_nexpix *
 259                             ( i_col_percent) * ( i_line_percent);
 260                         temp+= i_colpix *
 261                             i_col_percent * (256 - i_line_percent );
 262                         *p_out = temp >> 16;
 263                     }
 264                 #ifdef test
 265                     else if (i_col_orig == i_visible_pitch/2 )
 266                     {   *p_out = black_pixel;
 267                     }
 268                     else
 269                         *p_out = *p_orig_offset;
 270                 #endif
 271                 #undef test
 272                 }
 273                 else
 274                 {
 275                     *p_out = black_pixel;
 276                 }
 277
 278                 i_line_orig0 += i_sin;
 279                 i_col_orig0 += i_cos;
 280             }
 281
 282             i_line_orig0 += i_line_next;
 283             i_col_orig0 += i_col_next;
 284         }
 285     }
 286
 287     return CopyInfoAndRelease( p_outpic, p_pic );
 288 }
 289
 290 /*****************************************************************************
 291  *
 292  *****************************************************************************/
 293 static picture_t *FilterPacked( filter_t *p_filter, picture_t *p_pic )
 294 {
 295     picture_t *p_outpic;
 296     filter_sys_t *p_sys = p_filter->p_sys;
 297
 298     if( !p_pic ) return NULL;
 299
 300     int i_u_offset, i_v_offset, i_y_offset;
 301
 302     if( GetPackedYuvOffsets( p_pic->format.i_chroma, &i_y_offset,
 303                              &i_u_offset, &i_v_offset ) != VLC_SUCCESS )
 304     {
 305         msg_Warn( p_filter, "Unsupported input chroma (%4.4s)",
 306                   (char*)&(p_pic->format.i_chroma) );
 307         picture_Release( p_pic );
 308         return NULL;
 309     }
 310
 311     p_outpic = filter_NewPicture( p_filter );
 312     if( !p_outpic )
 313     {
 314         picture_Release( p_pic );
 315         return NULL;
 316     }
 317
 318     const int i_visible_pitch = p_pic->p->i_visible_pitch>>1; /* In fact it's i_visible_pixels */
 319     const int i_visible_lines = p_pic->p->i_visible_lines;
 320
 321     const uint8_t *p_in   = p_pic->p->p_pixels+i_y_offset;
 322     const uint8_t *p_in_u = p_pic->p->p_pixels+i_u_offset;
 323     const uint8_t *p_in_v = p_pic->p->p_pixels+i_v_offset;
 324     const int i_in_pitch  = p_pic->p->i_pitch;
 325
 326     uint8_t *p_out   = p_outpic->p->p_pixels+i_y_offset;
 327     uint8_t *p_out_u = p_outpic->p->p_pixels+i_u_offset;
 328     uint8_t *p_out_v = p_outpic->p->p_pixels+i_v_offset;
 329     const int i_out_pitch = p_outpic->p->i_pitch;
 330
 331     const int i_line_center = i_visible_lines>>1;
 332     const int i_col_center  = i_visible_pitch>>1;
 333
 334     vlc_spin_lock( &p_sys->lock );
 335     const int i_sin = p_sys->i_sin;
 336     const int i_cos = p_sys->i_cos;
 337     vlc_spin_unlock( &p_sys->lock );
 338
 339     int i_col, i_line;
 340     for( i_line = 0; i_line < i_visible_lines; i_line++ )
 341     {
 342         for( i_col = 0; i_col < i_visible_pitch; i_col++ )
 343         {
 344             int i_line_orig;
 345             int i_col_orig;
 346             /* Handle "1st Y", U and V */
 347             i_line_orig = i_line_center +
 348                 ( ( i_sin * ( i_col - i_col_center )
 349                   + i_cos * ( i_line - i_line_center ) )>>12 );
 350             i_col_orig = i_col_center +
 351                 ( ( i_cos * ( i_col - i_col_center )
 352                   - i_sin * ( i_line - i_line_center ) )>>12 );
 353             if( 0 <= i_col_orig && i_col_orig < i_visible_pitch
 354              && 0 <= i_line_orig && i_line_orig < i_visible_lines )
 355             {
 356                 p_out[i_line*i_out_pitch+2*i_col] = p_in[i_line_orig*i_in_pitch+2*i_col_orig];
 357                 i_col_orig /= 2;
 358                 p_out_u[i_line*i_out_pitch+2*i_col] = p_in_u[i_line_orig*i_in_pitch+4*i_col_orig];
 359                 p_out_v[i_line*i_out_pitch+2*i_col] = p_in_v[i_line_orig*i_in_pitch+4*i_col_orig];
 360             }
 361             else
 362             {
 363                 p_out[i_line*i_out_pitch+2*i_col] = 0x00;
 364                 p_out_u[i_line*i_out_pitch+2*i_col] = 0x80;
 365                 p_out_v[i_line*i_out_pitch+2*i_col] = 0x80;
 366             }
 367
 368             /* Handle "2nd Y" */
 369             i_col++;
 370             if( i_col >= i_visible_pitch )
 371                 break;
 372
 373             i_line_orig = i_line_center +
 374                 ( ( i_sin * ( i_col - i_col_center )
 375                   + i_cos * ( i_line - i_line_center ) )>>12 );
 376             i_col_orig = i_col_center +
 377                 ( ( i_cos * ( i_col - i_col_center )
 378                   - i_sin * ( i_line - i_line_center ) )>>12 );
 379             if( 0 <= i_col_orig && i_col_orig < i_visible_pitch
 380              && 0 <= i_line_orig && i_line_orig < i_visible_lines )
 381             {
 382                 p_out[i_line*i_out_pitch+2*i_col] = p_in[i_line_orig*i_in_pitch+2*i_col_orig];
 383             }
 384             else
 385             {
 386                 p_out[i_line*i_out_pitch+2*i_col] = 0x00;
 387             }
 388         }
 389     }
 390
 391     return CopyInfoAndRelease( p_outpic, p_pic );
 392 }
 393
 394 /*****************************************************************************
 395  * Angle modification callbacks.
 396  *****************************************************************************/
 397 static int RotateCallback( vlc_object_t *p_this, char const *psz_var,
 398                            vlc_value_t oldval, vlc_value_t newval,
 399                            void *p_data )
 400 {
 401     oldval.i_int *= 10;
 402     newval.i_int *= 10;
 403     return PreciseRotateCallback( p_this, psz_var, oldval, newval, p_data );
 404 }
 405
 406 static int PreciseRotateCallback( vlc_object_t *p_this, char const *psz_var,
 407                            vlc_value_t oldval, vlc_value_t newval,
 408                            void *p_data )
 409 {
 410     VLC_UNUSED(p_this); VLC_UNUSED(psz_var); VLC_UNUSED(oldval);
 411     filter_sys_t *p_sys = (filter_sys_t *)p_data;
 412     int i_sin, i_cos;
 413
 414     cache_trigo( newval.i_int, &i_sin, &i_cos );
 415     vlc_spin_lock( &p_sys->lock );
 416     p_sys->i_sin = i_sin;
 417     p_sys->i_cos = i_cos;
 418     vlc_spin_unlock( &p_sys->lock );
 419     return VLC_SUCCESS;
 420 }