2645
|
1 #define PES_MAX_SIZE 2048
|
|
2 /*
|
|
3 * vo_dxr3.c - DXR3/H+ video out
|
|
4 *
|
|
5 * Copyright (C) 2001 David Holm <dholm@iname.com>
|
|
6 *
|
|
7 * libav - MPEG-PS multiplexer, part of ffmpeg
|
|
8 * Copyright Gerard Lantau (see http://ffmpeg.sf.net)
|
|
9 *
|
|
10 */
|
|
11
|
|
12 #include "fastmemcpy.h"
|
|
13 #include <stdio.h>
|
|
14 #include <stdlib.h>
|
|
15 #include <string.h>
|
|
16
|
|
17 #include <stdio.h>
|
|
18 #include <time.h>
|
|
19 #include <unistd.h>
|
|
20
|
|
21 #include <libdxr3/api.h>
|
|
22
|
|
23 #include "config.h"
|
|
24 #include "video_out.h"
|
|
25 #include "video_out_internal.h"
|
|
26
|
2770
|
27 #include "../opendivx/yuv2rgb.h"
|
2645
|
28 #ifdef HAVE_MMX
|
|
29 #include "mmx.h"
|
|
30 #endif
|
|
31
|
|
32 LIBVO_EXTERN (dxr3)
|
|
33
|
|
34 #ifdef USE_LIBAVCODEC
|
|
35
|
|
36 #ifdef USE_LIBAVCODEC_SO
|
|
37 #include <libffmpeg/avcodec.h>
|
|
38 #else
|
|
39 #include "../libavcodec/avcodec.h"
|
|
40 #endif
|
|
41 static AVPicture picture;
|
|
42 static AVCodec *codec=NULL;
|
|
43 static AVCodecContext codec_context;
|
|
44 extern int avcodec_inited;
|
|
45 #endif
|
|
46
|
|
47 static unsigned char *picture_buf=NULL;
|
|
48 static unsigned char *outbuf=NULL;
|
2770
|
49 static unsigned char *spubuf=NULL;
|
|
50 static int outbuf_size = 0;
|
|
51 static int v_width,v_height;
|
2645
|
52 static int s_pos_x,s_pos_y;
|
|
53 static int d_pos_x,d_pos_y;
|
|
54 static int osd_w,osd_h;
|
2770
|
55 static int img_format = 0;
|
|
56 static int palette[] = { 0x0000, 0x4949, 0xb5b5, 0xffff };
|
2645
|
57
|
|
58 static vo_info_t vo_info =
|
|
59 {
|
|
60 "DXR3/H+ video out",
|
|
61 "dxr3",
|
|
62 "David Holm <dholm@iname.com>",
|
|
63 ""
|
|
64 };
|
|
65
|
|
66 static uint32_t
|
|
67 init(uint32_t s_width, uint32_t s_height, uint32_t width, uint32_t height, uint32_t fullscreen, char *title, uint32_t format)
|
|
68 {
|
|
69 if( dxr3_get_status() == DXR3_STATUS_CLOSED )
|
|
70 {
|
2770
|
71 if( dxr3_open( "/dev/em8300" ) != 0 ) { printf( "Error opening /dev/em8300\n" ); return -1; }
|
2645
|
72 printf( "DXR3 status: %s\n", dxr3_get_status() ? "opened":"closed" );
|
|
73 }
|
|
74
|
2770
|
75 /* Subpic code isn't working yet, don't set to ON
|
|
76 unless you are really sure what you are doing */
|
|
77 dxr3_subpic_set_mode( DXR3_SPU_MODE_OFF );
|
|
78 dxr3_subpic_set_palette( (char*)palette );
|
|
79 spubuf = malloc(width*height);
|
|
80
|
2645
|
81 if( dxr3_set_playmode( DXR3_PLAYMODE_PLAY ) !=0 ) printf( "Error setting playmode of DXR3\n" );
|
|
82
|
|
83 img_format = format;
|
2770
|
84 v_width = width;
|
|
85 v_height = height;
|
2645
|
86 picture_buf=NULL;
|
2770
|
87
|
2645
|
88 if( format == IMGFMT_YV12 )
|
|
89 {
|
|
90 #ifdef USE_LIBAVCODEC
|
|
91
|
|
92 int size;
|
|
93
|
|
94 printf("Format: YV12\n");
|
|
95
|
|
96 if(!avcodec_inited){
|
|
97 avcodec_init();
|
|
98 avcodec_register_all();
|
|
99 avcodec_inited=1;
|
|
100 }
|
|
101
|
|
102 /* find the mpeg1 video encoder */
|
|
103 codec = avcodec_find_encoder(CODEC_ID_MPEG1VIDEO);
|
|
104 if (!codec) {
|
|
105 fprintf(stderr, "mpeg1 codec not found\n");
|
|
106 return -1;
|
|
107 }
|
|
108
|
|
109 memset(&codec_context,0,sizeof(codec_context));
|
|
110 codec_context.bit_rate=100000; // not used
|
2770
|
111 codec_context.frame_rate=25*FRAME_RATE_BASE;
|
|
112 codec_context.gop_size=0;
|
2645
|
113 codec_context.flags=CODEC_FLAG_QSCALE;
|
2770
|
114 codec_context.quality=1;
|
|
115 codec_context.pix_fmt = PIX_FMT_YUV420P;
|
2645
|
116 if(width<=352 && height<=288){
|
|
117 codec_context.width=352;
|
|
118 codec_context.height=288;
|
|
119 } else
|
|
120 if(width<=352 && height<=576){
|
|
121 codec_context.width=352;
|
|
122 codec_context.height=576;
|
|
123 } else
|
|
124 if(width<=480 && height<=576){
|
|
125 codec_context.width=480;
|
|
126 codec_context.height=576;
|
|
127 } else
|
|
128 if(width<=544 && height<=576){
|
|
129 codec_context.width=544;
|
|
130 codec_context.height=576;
|
|
131 } else {
|
|
132 codec_context.width=704;
|
|
133 codec_context.height=576;
|
|
134 }
|
|
135
|
|
136 osd_w=s_width;
|
|
137 d_pos_x=(codec_context.width-(int)s_width)/2;
|
|
138 if(d_pos_x<0){
|
|
139 s_pos_x=-d_pos_x;d_pos_x=0;
|
|
140 osd_w=codec_context.width;
|
|
141 } else s_pos_x=0;
|
|
142
|
|
143 osd_h=s_height;
|
|
144 d_pos_y=(codec_context.height-(int)s_height)/2;
|
|
145 if(d_pos_y<0){
|
|
146 s_pos_y=-d_pos_y;d_pos_y=0;
|
|
147 osd_h=codec_context.height;
|
|
148 } else s_pos_y=0;
|
|
149
|
|
150 printf("[vo] position mapping: %d;%d => %d;%d\n",s_pos_x,s_pos_y,d_pos_x,d_pos_y);
|
|
151
|
|
152 /* open it */
|
|
153 if (avcodec_open(&codec_context, codec) < 0) {
|
|
154 fprintf(stderr, "could not open codec\n");
|
|
155 return -1;
|
|
156 }
|
|
157
|
2770
|
158 outbuf_size=10000+width*height*4;
|
2645
|
159 outbuf = malloc(outbuf_size);
|
|
160
|
|
161 size = codec_context.width*codec_context.height;
|
2770
|
162 picture_buf = malloc((size * 3)/2); /* size for YUV 420 */
|
|
163
|
|
164 picture.data[0] = picture_buf;
|
|
165 picture.data[1] = picture.data[0] + size;
|
|
166 picture.data[2] = picture.data[1] + size / 4;
|
|
167 picture.linesize[0] = codec_context.width;
|
|
168 picture.linesize[1] = codec_context.width / 2;
|
|
169 picture.linesize[2] = codec_context.width / 2;
|
|
170
|
|
171 return 0;
|
|
172 #endif
|
|
173 return -1;
|
|
174 }
|
|
175 else if(format==IMGFMT_BGR24)
|
|
176 {
|
|
177 #ifdef USE_LIBAVCODEC
|
|
178 int size = 0;
|
|
179 printf("Format: BGR24\n");
|
|
180
|
|
181 if(!avcodec_inited)
|
|
182 {
|
|
183 avcodec_init();
|
|
184 avcodec_register_all();
|
|
185 avcodec_inited=1;
|
|
186 }
|
|
187
|
|
188 /* find the mpeg1 video encoder */
|
|
189 codec = avcodec_find_encoder(CODEC_ID_MPEG1VIDEO);
|
|
190 if (!codec)
|
|
191 {
|
|
192 fprintf(stderr, "mpeg1 codec not found\n");
|
|
193 return -1;
|
|
194 }
|
|
195
|
|
196 outbuf_size=10000+width*height*4;
|
|
197 outbuf = malloc(outbuf_size);
|
|
198
|
|
199 memset(&codec_context,0,sizeof(codec_context));
|
|
200 codec_context.bit_rate=100000;
|
|
201 codec_context.frame_rate=25*FRAME_RATE_BASE;
|
|
202 codec_context.gop_size=0;
|
|
203 codec_context.flags=CODEC_FLAG_QSCALE;
|
|
204 codec_context.quality=1;
|
|
205 codec_context.pix_fmt = PIX_FMT_YUV420P;
|
|
206
|
|
207 /* codec_context.width=width;
|
|
208 codec_context.height=height;*/
|
|
209 if(width<=352 && height<=288){
|
|
210 codec_context.width=352;
|
|
211 codec_context.height=288;
|
|
212 } else
|
|
213 if(width<=352 && height<=576){
|
|
214 codec_context.width=352;
|
|
215 codec_context.height=576;
|
|
216 } else
|
|
217 if(width<=480 && height<=576){
|
|
218 codec_context.width=480;
|
|
219 codec_context.height=576;
|
|
220 } else
|
|
221 if(width<=544 && height<=576){
|
|
222 codec_context.width=544;
|
|
223 codec_context.height=576;
|
|
224 } else {
|
|
225 codec_context.width=704;
|
|
226 codec_context.height=576;
|
|
227 }
|
|
228
|
|
229 osd_w=s_width;
|
|
230 d_pos_x=(codec_context.width-(int)s_width)/2;
|
|
231 if(d_pos_x<0){
|
|
232 s_pos_x=-d_pos_x;d_pos_x=0;
|
|
233 osd_w=codec_context.width;
|
|
234 } else s_pos_x=0;
|
|
235
|
|
236 osd_h=s_height;
|
|
237 d_pos_y=(codec_context.height-(int)s_height)/2;
|
|
238 if(d_pos_y<0){
|
|
239 s_pos_y=-d_pos_y;d_pos_y=0;
|
|
240 osd_h=codec_context.height;
|
|
241 } else s_pos_y=0;
|
|
242
|
|
243 printf("[vo] position mapping: %d;%d => %d;%d\n",s_pos_x,s_pos_y,d_pos_x,d_pos_y);
|
|
244
|
|
245 /* open it */
|
|
246 if (avcodec_open(&codec_context, codec) < 0) {
|
|
247 fprintf(stderr, "could not open codec\n");
|
|
248 return -1;
|
|
249 }
|
|
250
|
|
251 size = codec_context.width*codec_context.height;
|
|
252 picture_buf = malloc((size * 3)/2);
|
2645
|
253
|
|
254 picture.data[0] = picture_buf;
|
|
255 picture.data[1] = picture.data[0] + size;
|
|
256 picture.data[2] = picture.data[1] + size / 4;
|
|
257 picture.linesize[0] = codec_context.width;
|
|
258 picture.linesize[1] = codec_context.width / 2;
|
|
259 picture.linesize[2] = codec_context.width / 2;
|
|
260 return 0;
|
|
261 #endif
|
2770
|
262 return -1;
|
2645
|
263 }
|
|
264 else if(format==IMGFMT_MPEGPES)
|
|
265 {
|
|
266 printf( "Format: MPEG-PES\n" );
|
|
267 return 0;
|
|
268 }
|
|
269
|
|
270 printf( "Format: Unsupported\n" );
|
|
271 return -1;
|
|
272 }
|
|
273
|
|
274 static const vo_info_t*
|
|
275 get_info(void)
|
|
276 {
|
|
277 return &vo_info;
|
|
278 }
|
|
279
|
2770
|
280 static void draw_alpha(int x, int y, int w, int h, unsigned char* src, unsigned char *srca, int srcstride)
|
2645
|
281 {
|
2770
|
282 int i,skip=0,index=0;
|
|
283 unsigned char *dst = spubuf;
|
|
284 for( i = (y*w)+x; i < w*h; i++ )
|
|
285 {
|
|
286 if(srca[i]) {*dst=skip;skip=0;dst++;*dst=3;dst++;index+=2;}
|
|
287 else skip++;
|
|
288 }
|
|
289
|
|
290 dxr3_subpic_write(spubuf,index);
|
2645
|
291 }
|
|
292
|
|
293 static void draw_osd(void)
|
|
294 {
|
|
295 vo_draw_text(osd_w,osd_h,draw_alpha);
|
|
296 }
|
|
297
|
|
298 static uint32_t draw_frame(uint8_t * src[])
|
|
299 {
|
|
300 if( img_format == IMGFMT_MPEGPES )
|
|
301 {
|
2770
|
302 int data_left;
|
2645
|
303 vo_mpegpes_t *p=(vo_mpegpes_t *)src[0];
|
|
304
|
|
305 data_left = p->size;
|
|
306 while( data_left )
|
|
307 data_left -= dxr3_video_write( &((unsigned char*)p->data)[p->size-data_left], data_left );
|
|
308
|
|
309 return 0;
|
|
310 }
|
|
311 #ifdef USE_LIBAVCODEC
|
|
312 else if( img_format == IMGFMT_YV12 )
|
|
313 {
|
|
314 printf("ERROR: Uninplemented\n");
|
|
315 }
|
2770
|
316 else if( img_format == IMGFMT_BGR24 )
|
|
317 {
|
|
318 int tmp_size, out_size;
|
|
319 int wrap, wrap3, x, y;
|
|
320 int r, g, b, R, G, B, h = v_height, w = v_width;
|
|
321 unsigned char *s, *Y, *U, *V;
|
|
322
|
|
323 if(d_pos_x+w>picture.linesize[0]) w=picture.linesize[0]-d_pos_x;
|
|
324 if(d_pos_y+h>codec_context.height) h=codec_context.height-d_pos_y;
|
|
325
|
|
326 Y = picture.data[0]+d_pos_x+d_pos_y*picture.linesize[0];
|
|
327 U = picture.data[1]+(d_pos_x/2)+(d_pos_y/2)*picture.linesize[1];
|
|
328 V = picture.data[2]+(d_pos_x/2)+(d_pos_y/2)*picture.linesize[2];
|
|
329
|
|
330 //BGR24->YUV420P from ffmpeg, see ffmpeg.sourceforge.net for terms of license
|
|
331 #define SCALEBITS 8
|
|
332 #define ONE_HALF (1 << (SCALEBITS - 1))
|
|
333 #define FIX(x) ((int) ((x) * (1L<<SCALEBITS) + 0.5))
|
|
334 wrap = w;
|
|
335 wrap3 = w * 3;
|
|
336 s = src[0];
|
|
337 for( y = 0; y < h; y+=2 )
|
|
338 {
|
|
339 for( x = 0; x < w; x+=2 )
|
|
340 {
|
|
341 b = s[0];
|
|
342 g = s[1];
|
|
343 r = s[2];
|
|
344 R = r;
|
|
345 G = g;
|
|
346 B = b;
|
|
347 Y[0] = (FIX(0.29900) * r + FIX(0.58700) * g + FIX(0.11400) * b + ONE_HALF) >> SCALEBITS;
|
|
348 b = s[3];
|
|
349 g = s[4];
|
|
350 r = s[5];
|
|
351 R += r;
|
|
352 G += g;
|
|
353 B += b;
|
|
354 Y[1] = (FIX(0.29900) * r + FIX(0.58700) * g + FIX(0.11400) * b + ONE_HALF) >> SCALEBITS;
|
|
355 s += wrap3;
|
|
356 Y += wrap;
|
|
357
|
|
358 b = s[0];
|
|
359 g = s[1];
|
|
360 r = s[2];
|
|
361 R += r;
|
|
362 G += g;
|
|
363 B += b;
|
|
364 Y[0] = (FIX(0.29900) * r + FIX(0.58700) * g + FIX(0.11400) * b + ONE_HALF) >> SCALEBITS;
|
|
365 b = s[3];
|
|
366 g = s[4];
|
|
367 r = s[5];
|
|
368 R += r;
|
|
369 G += g;
|
|
370 B += b;
|
|
371 Y[1] = (FIX(0.29900) * r + FIX(0.58700) * g + FIX(0.11400) * b + ONE_HALF) >> SCALEBITS;
|
|
372 U[0] = ((- FIX(0.16874) * R - FIX(0.33126) * G - FIX(0.50000) * B + 4 * ONE_HALF - 1) >> (SCALEBITS + 2)) + 128;
|
|
373 V[0] = ((FIX(0.50000) * R - FIX(0.41869) * G - FIX(0.08131) * B + 4 * ONE_HALF - 1) >> (SCALEBITS + 2)) + 128;
|
|
374
|
|
375 U++;
|
|
376 V++;
|
|
377 s -= (wrap3-6);
|
|
378 Y -= (wrap-2);
|
|
379 }
|
|
380 s += wrap3;
|
|
381 Y += wrap;
|
|
382 }
|
|
383 #undef SCALEBITS
|
|
384 #undef ONE_HALF
|
|
385 #undef FIX(x)
|
|
386 //End of ffmpeg code, see ffmpeg.sourceforge.net for terms of license
|
|
387 tmp_size = out_size = avcodec_encode_video(&codec_context, outbuf, outbuf_size, &picture);
|
|
388 while( out_size )
|
|
389 out_size -= dxr3_video_write( &outbuf[tmp_size-out_size], out_size );
|
|
390
|
|
391 return 0;
|
|
392 }
|
2645
|
393 #endif
|
|
394
|
2770
|
395 printf( "Error in draw_frame(...)\n" );
|
2645
|
396 return -1;
|
|
397 }
|
|
398
|
|
399 static void flip_page (void)
|
|
400 {
|
|
401 }
|
|
402
|
|
403 static uint32_t draw_slice( uint8_t *srcimg[], int stride[], int w, int h, int x0, int y0 )
|
|
404 {
|
|
405 int y;
|
|
406 unsigned char* s;
|
|
407 unsigned char* d;
|
|
408 int data_left;
|
|
409 vo_mpegpes_t *p = (vo_mpegpes_t *)srcimg[0];
|
|
410
|
|
411 if( img_format == IMGFMT_YV12 )
|
|
412 {
|
|
413 #ifdef USE_LIBAVCODEC
|
2770
|
414 int out_size, tmp_size;
|
2645
|
415 x0+=d_pos_x;
|
|
416 y0+=d_pos_y;
|
|
417 if(x0+w>picture.linesize[0]) w=picture.linesize[0]-x0; // !!
|
|
418 if(y0+h>codec_context.height) h=codec_context.height-y0;
|
|
419
|
|
420 // Y
|
|
421 s=srcimg[0]+s_pos_x+s_pos_y*stride[0];
|
|
422 d=picture.data[0]+x0+y0*picture.linesize[0];
|
|
423 for( y = 0; y < h; y++)
|
|
424 {
|
|
425 memcpy(d,s,w);
|
|
426 s+=stride[0];
|
|
427 d+=picture.linesize[0];
|
|
428 }
|
|
429
|
|
430 w/=2;h/=2;x0/=2;y0/=2;
|
|
431
|
|
432 // U
|
|
433 s=srcimg[1]+(s_pos_x/2)+(s_pos_y/2)*stride[1];
|
|
434 d=picture.data[1]+x0+y0*picture.linesize[1];
|
|
435 for( y = 0; y < h; y++)
|
|
436 {
|
|
437 memcpy(d,s,w);
|
|
438 s+=stride[1];
|
|
439 d+=picture.linesize[1];
|
|
440 }
|
|
441
|
|
442 // V
|
|
443 s=srcimg[2]+(s_pos_x/2)+(s_pos_y/2)*stride[2];
|
|
444 d=picture.data[2]+x0+y0*picture.linesize[2];
|
|
445 for(y=0;y<h;y++)
|
|
446 {
|
|
447 memcpy(d,s,w);
|
|
448 s+=stride[2];
|
|
449 d+=picture.linesize[2];
|
|
450 }
|
2770
|
451
|
|
452 tmp_size = out_size = avcodec_encode_video(&codec_context, outbuf, outbuf_size, &picture);
|
|
453 while( out_size )
|
|
454 out_size -= dxr3_video_write( &outbuf[tmp_size-out_size], out_size );
|
2645
|
455
|
|
456 return 0;
|
|
457 #endif
|
2770
|
458 return -1;
|
|
459 }
|
|
460 else if( img_format == IMGFMT_BGR24 )
|
|
461 {
|
2645
|
462 return -1;
|
|
463 }
|
|
464 else if( img_format == IMGFMT_MPEGPES )
|
|
465 {
|
|
466 data_left = p->size;
|
|
467 while( data_left )
|
|
468 data_left -= dxr3_video_write( &((unsigned char*)p->data)[p->size-data_left], data_left );
|
|
469 return 0;
|
|
470 }
|
|
471
|
|
472 return -1;
|
|
473 }
|
|
474
|
|
475
|
|
476 static uint32_t
|
|
477 query_format(uint32_t format)
|
|
478 {
|
2770
|
479 if(format==IMGFMT_MPEGPES) return 0x2|0x4;
|
2645
|
480 #ifdef USE_LIBAVCODEC
|
2770
|
481 if(format==IMGFMT_YV12) return 0x1|0x4;
|
|
482 if(format==IMGFMT_BGR24) return 0x1|0x4;
|
|
483 #else
|
|
484 if(format==IMGFMT_YV12) {printf("You need to compile with libavcodec or ffmpeg.so to play this file!\n" ); return 0;}
|
|
485 if(format==IMGFMT_BGR24) {printf("You need to compile with libavcodec or ffmpeg.so to play this file!\n" ); return 0;}
|
|
486 #endif
|
2645
|
487 return 0;
|
|
488 }
|
|
489
|
|
490 static void
|
|
491 uninit(void)
|
|
492 {
|
2770
|
493 free(outbuf);
|
|
494 free(picture_buf);
|
|
495 free(spubuf);
|
2645
|
496 dxr3_close( );
|
|
497 }
|
|
498
|
|
499
|
|
500 static void check_events(void)
|
|
501 {
|
|
502 }
|
|
503
|