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