Remove unnedeeded msg_Error.
[vlc.git] / 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         return VLC_ENOMEM;
135     p_sys = p_filter->p_sys;
136
137     config_ChainParse( p_filter, FILTER_PREFIX, ppsz_filter_options,
138                        p_filter->p_cfg );
139
140     p_sys->i_angle = var_CreateGetIntegerCommand( p_filter,
141                                                   FILTER_PREFIX "angle" ) * 10;
142     var_Create( p_filter, FILTER_PREFIX "deciangle",
143                 VLC_VAR_INTEGER|VLC_VAR_ISCOMMAND );
144     var_AddCallback( p_filter, FILTER_PREFIX "angle", RotateCallback, p_sys );
145     var_AddCallback( p_filter, FILTER_PREFIX "deciangle",
146                      PreciseRotateCallback, p_sys );
147
148     cache_trigo( p_sys->i_angle, &p_sys->i_sin, &p_sys->i_cos );
149
150     return VLC_SUCCESS;
151 }
152
153 /*****************************************************************************
154  * Destroy: destroy Distort filter
155  *****************************************************************************/
156 static void Destroy( vlc_object_t *p_this )
157 {
158     filter_t *p_filter = (filter_t *)p_this;
159
160     free( p_filter->p_sys );
161 }
162
163 /*****************************************************************************
164  *
165  *****************************************************************************/
166 static picture_t *Filter( filter_t *p_filter, picture_t *p_pic )
167 {
168     picture_t *p_outpic;
169     filter_sys_t *p_sys = p_filter->p_sys;
170     int i_plane;
171     const int i_sin = p_sys->i_sin, i_cos = p_sys->i_cos;
172
173     if( !p_pic ) return NULL;
174
175     p_outpic = p_filter->pf_vout_buffer_new( p_filter );
176     if( !p_outpic )
177     {
178         msg_Warn( p_filter, "can't get output picture" );
179         if( p_pic->pf_release )
180             p_pic->pf_release( p_pic );
181         return NULL;
182     }
183
184     for( i_plane = 0 ; i_plane < p_pic->i_planes ; i_plane++ )
185     {
186         const int i_visible_lines = p_pic->p[i_plane].i_visible_lines;
187         const int i_visible_pitch = p_pic->p[i_plane].i_visible_pitch;
188         const int i_pitch         = p_pic->p[i_plane].i_pitch;
189         const int i_hidden_pitch  = i_pitch - i_visible_pitch;
190
191         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 );
192         /* = 2 for U and V planes in YUV 4:2:2, = 1 otherwise */
193
194         const int i_line_center = i_visible_lines>>1;
195         const int i_col_center  = i_visible_pitch>>1;
196
197         const uint8_t *p_in = p_pic->p[i_plane].p_pixels;
198         uint8_t *p_out = p_outpic->p[i_plane].p_pixels;
199         uint8_t *p_outendline = p_out + i_visible_pitch;
200         const uint8_t *p_outend = p_out + i_visible_lines * i_pitch;
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( ; p_outendline < p_outend;
211              p_out += i_hidden_pitch, p_outendline += i_pitch,
212              i_line_orig0 += i_line_next, i_col_orig0 += i_col_next )
213         {
214             for( ; p_out < p_outendline;
215                  p_out++, i_line_orig0 += i_sin, i_col_orig0 += i_cos )
216             {
217                 const int i_line_orig = (i_line_orig0>>12)*i_aspect + i_line_center;
218                 const int i_col_orig  = (i_col_orig0>>12)  + i_col_center;
219                 const uint8_t* p_orig_offset = p_in + i_line_orig * i_pitch
220                                                 + i_col_orig;
221                 const uint8_t i_line_percent = (i_line_orig0>>4) & 255;
222                 const uint8_t i_col_percent  = (i_col_orig0 >>4) & 255;
223
224                 if(    -1 <= i_line_orig && i_line_orig < i_visible_lines
225                     && -1 <= i_col_orig  && i_col_orig  < i_visible_pitch )
226                 {
227                 #define test 1
228                 #undef test
229                 #ifdef test
230                     if( ( i_col_orig > i_visible_pitch/2 ) )
231                 #endif
232                     {
233                         uint8_t i_curpix = black_pixel;
234                         uint8_t i_colpix = black_pixel;
235                         uint8_t i_linpix = black_pixel;
236                         uint8_t i_nexpix = black_pixel;
237                         if( ( 0 <= i_line_orig ) && ( 0 <= i_col_orig ) )
238                             i_curpix = *p_orig_offset;
239                         p_orig_offset++;
240
241                         if(  ( i_col_orig < i_visible_pitch - 1)
242                              && ( i_line_orig >= 0 ) )
243                             i_colpix = *p_orig_offset;
244
245                         p_orig_offset+=i_pitch;
246                         if( ( i_line_orig < i_visible_lines - 1)
247                             && ( i_col_orig  < i_visible_pitch - 1) )
248                             i_nexpix = *p_orig_offset;
249
250                         p_orig_offset--;
251                         if(  ( i_line_orig < i_visible_lines - 1)
252                              && ( i_col_orig >= 0 ) )
253                             i_linpix = *p_orig_offset;
254
255                         unsigned int temp = 0;
256                         temp+= i_curpix *
257                             (256 - i_line_percent) * ( 256 - i_col_percent );
258                         temp+= i_linpix *
259                             i_line_percent * (256 - i_col_percent );
260                         temp+= i_nexpix *
261                             ( i_col_percent) * ( i_line_percent);
262                         temp+= i_colpix *
263                             i_col_percent * (256 - i_line_percent );
264                         *p_out = temp >> 16;
265                     }
266                 #ifdef test
267                     else if (i_col_orig == i_visible_pitch/2 )
268                     {   *p_out = black_pixel;
269                     }
270                     else
271                         *p_out = *p_orig_offset;
272                 #endif
273                 #undef test
274                 }
275                 else
276                 {
277                     *p_out = black_pixel;
278                 }
279             }
280         }
281     }
282
283     return CopyInfoAndRelease( p_outpic, p_pic );
284 }
285
286 /*****************************************************************************
287  *
288  *****************************************************************************/
289 static picture_t *FilterPacked( filter_t *p_filter, picture_t *p_pic )
290 {
291     picture_t *p_outpic;
292     filter_sys_t *p_sys = p_filter->p_sys;
293     const int i_sin = p_sys->i_sin, i_cos = p_sys->i_cos;
294
295     if( !p_pic ) return NULL;
296
297     int i_u_offset, i_v_offset, i_y_offset;
298
299     if( GetPackedYuvOffsets( p_pic->format.i_chroma, &i_y_offset,
300                              &i_u_offset, &i_v_offset ) != VLC_SUCCESS )
301     {
302         msg_Warn( p_filter, "Unsupported input chroma (%4s)",
303                   (char*)&(p_pic->format.i_chroma) );
304         if( p_pic->pf_release )
305             p_pic->pf_release( p_pic );
306         return NULL;
307     }
308
309     p_outpic = p_filter->pf_vout_buffer_new( p_filter );
310     if( !p_outpic )
311     {
312         msg_Warn( p_filter, "can't get output picture" );
313         if( p_pic->pf_release )
314             p_pic->pf_release( p_pic );
315         return NULL;
316     }
317
318     const uint8_t *p_in   = p_pic->p->p_pixels+i_y_offset;
319     const uint8_t *p_in_u = p_pic->p->p_pixels+i_u_offset;
320     const uint8_t *p_in_v = p_pic->p->p_pixels+i_v_offset;
321
322     const int i_pitch         = p_pic->p->i_pitch;
323     const int i_visible_pitch = p_pic->p->i_visible_pitch>>1; /* In fact it's i_visible_pixels */
324     const int i_visible_lines = p_pic->p->i_visible_lines;
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
330     const int i_line_center = i_visible_lines>>1;
331     const int i_col_center  = i_visible_pitch>>1;
332
333     int i_col, i_line;
334     for( i_line = 0; i_line < i_visible_lines; i_line++ )
335     {
336         for( i_col = 0; i_col < i_visible_pitch; i_col++ )
337         {
338             int i_line_orig;
339             int i_col_orig;
340             /* Handle "1st Y", U and V */
341             i_line_orig = i_line_center +
342                 ( ( i_sin * ( i_col - i_col_center )
343                   + i_cos * ( i_line - i_line_center ) )>>12 );
344             i_col_orig = i_col_center +
345                 ( ( i_cos * ( i_col - i_col_center )
346                   - i_sin * ( i_line - i_line_center ) )>>12 );
347             if( 0 <= i_col_orig && i_col_orig < i_visible_pitch
348              && 0 <= i_line_orig && i_line_orig < i_visible_lines )
349             {
350                 p_out[i_line*i_pitch+2*i_col] = p_in[i_line_orig*i_pitch+2*i_col_orig];
351                 i_col_orig /= 2;
352                 p_out_u[i_line*i_pitch+2*i_col] = p_in_u[i_line_orig*i_pitch+4*i_col_orig];
353                 p_out_v[i_line*i_pitch+2*i_col] = p_in_v[i_line_orig*i_pitch+4*i_col_orig];
354             }
355             else
356             {
357                 p_out[i_line*i_pitch+2*i_col] = 0x00;
358                 p_out_u[i_line*i_pitch+2*i_col] = 0x80;
359                 p_out_v[i_line*i_pitch+2*i_col] = 0x80;
360             }
361
362             /* Handle "2nd Y" */
363             i_col++;
364             if( i_col >= i_visible_pitch )
365                 break;
366
367             i_line_orig = i_line_center +
368                 ( ( i_sin * ( i_col - i_col_center )
369                   + i_cos * ( i_line - i_line_center ) )>>12 );
370             i_col_orig = i_col_center +
371                 ( ( i_cos * ( i_col - i_col_center )
372                   - i_sin * ( i_line - i_line_center ) )>>12 );
373             if( 0 <= i_col_orig && i_col_orig < i_visible_pitch
374              && 0 <= i_line_orig && i_line_orig < i_visible_lines )
375             {
376                 p_out[i_line*i_pitch+2*i_col] = p_in[i_line_orig*i_pitch+2*i_col_orig];
377             }
378             else
379             {
380                 p_out[i_line*i_pitch+2*i_col] = 0x00;
381             }
382         }
383     }
384
385     return CopyInfoAndRelease( p_outpic, p_pic );
386 }
387
388 /*****************************************************************************
389  * Angle modification callbacks.
390  *****************************************************************************/
391 static int RotateCallback( vlc_object_t *p_this, char const *psz_var,
392                            vlc_value_t oldval, vlc_value_t newval,
393                            void *p_data )
394 {
395     VLC_UNUSED(p_this); VLC_UNUSED(psz_var); VLC_UNUSED(oldval);
396     filter_sys_t *p_sys = (filter_sys_t *)p_data;
397     p_sys->i_angle = newval.i_int*10;
398     cache_trigo( p_sys->i_angle, &p_sys->i_sin, &p_sys->i_cos );
399     return VLC_SUCCESS;
400 }
401
402 static int PreciseRotateCallback( vlc_object_t *p_this, char const *psz_var,
403                            vlc_value_t oldval, vlc_value_t newval,
404                            void *p_data )
405 {
406     VLC_UNUSED(p_this); VLC_UNUSED(psz_var); VLC_UNUSED(oldval);
407     filter_sys_t *p_sys = (filter_sys_t *)p_data;
408     p_sys->i_angle = newval.i_int;
409     cache_trigo( p_sys->i_angle, &p_sys->i_sin, &p_sys->i_cos );
410     return VLC_SUCCESS;
411 }