modules/video_filter/rotate.c

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