Subversion Repositories shark

/*

 * Project: S.Ha.R.K.

 *

 * Coordinators:

 *   Giorgio Buttazzo    <giorgio@sssup.it>

 *   Paolo Gai           <pj@gandalf.sssup.it>

 *

 * Authors     :

 *   Paolo Gai           <pj@gandalf.sssup.it>

 *   (see the web pages for full authors list)

 *

 * ReTiS Lab (Scuola Superiore S.Anna - Pisa - Italy)

 *

 * http://www.sssup.it

 * http://retis.sssup.it

 * http://shark.sssup.it

 */

/*

 * Copyright (C) 1999 Luca Abeni and Massimiliano Giorgi

 *

 * This program is free software; you can redistribute it and/or modify

 * it under the terms of the GNU General Public License as published by

 * the Free Software Foundation; either version 2 of the License, or

 * (at your option) any later version.

 *

 * This program is distributed in the hope that it will be useful,

 * but WITHOUT ANY WARRANTY; without even the implied warranty of

 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

 * GNU General Public License for more details.

 *

 * You should have received a copy of the GNU General Public License

 * along with this program; if not, write to the Free Software

 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA

 *

 */

/*

 * CVS :        $Id: gvideo.c,v 1.1.1.1 2004-05-24 18:03:44 giacomo Exp $

 *

 * File:        $File$

 * Revision:    $Revision: 1.1.1.1 $

 * Last update: $Date: 2004-05-24 18:03:44 $

 */

#include "config.h"

#include <kernel/func.h>

#include <kernel/model.h>

#include <kernel/const.h>

#include <drivers/glib.h>

#include <stdlib.h>

#include "mpeg/video.h"

#include "mpeg/util.h"

#include "mpeg/dither.h"

#include "mpeg/mpeg.h"

#include "mutex.h"

#include "gvideo.h"

#include "gbuffer.h"

#include "xread.h"

#define STARTGROUP 513

#define VIDEORATE 70

#define READRATE  30

/*

 * colors

 */

#ifdef FULLCOLOR

#define COLORFG rgb16(255,255,255)

#define COLORBG rgb16(0,0,0)

#define SP rgb16(0,128,0)

#define FG rgb16(255,255,255)

#define BG rgb16(0,0,0)

#else

/* for writing */

#define COLORFG 255

#define COLORBG 0

/* for box */

#define SP 128

#define FG 255

#define BG 0

#endif

/* border size (pixels) */

#define BO 4

/*

 *

 */

#ifdef FULLCOLOR

/* 16bits format 5:6:5 */

/* 32bits format 8:8:8:0 */

void down32to16(WORD *dst, BYTE *src, int size)

{

  int i;

  return;

  for (i=0;i<size;i+=4,dst++,src+=4)

    /* blue green red */

    *dst=((src[2]&0xf8)>>3)|((src[1]&0xfc)<<3)|((src[0]&0xf8)<<8);

}

#endif

/*

 *

 */

void draw_frame(int x, int y, int dx, int dy)

{

#ifndef NOGRX

  grxlock();

  grx_box(x-1-BO,y-1-BO,x+dx+BO,y+dy+BO,SP);

  grx_rect(x-1-BO,y-1-BO,x+dx+BO,y+dy+BO,FG);

  grx_box(x,y,x+dx-1,y+dy-1,BG);

  grx_rect(x-1,y-1,x+dx,y+dy,FG);

  grxunlock();

#endif

}

struct info {

  int       x,y;

  ImageDesc *img;

};

static TASK play(void *arg)

{

  struct info *ptr=(struct info*)arg;

  int x1,y1,x2,y2;

  BYTE *pixels; //,*image;

  int moreframes;

  pixels=(BYTE*)malloc(ptr->img->Size*sizeof(BYTE));

#ifdef FULLCOLOR

  image=(BYTE*)malloc(ptr->img->Size/2*sizeof(BYTE));

#endif

  x1=ptr->x;

  y1=ptr->y;

  x2=x1+ptr->img->Width-1;

  y2=y1+ptr->img->Height-1;

  moreframes=1;

  for (;;) {

    while (moreframes) {

      moreframes=GetMPEGFrame(ptr->img,pixels);

#ifndef NOGRX

#ifdef FULLCOLOR

      down32to16((WORD*)image,pixels,ptr->img->Size);

      grxlock();

      grx_putimage(x1, y1, x2, y2, pixels);

      grxunlock();

#else

      grxlock();

      grx_putimage(x1, y1, x2, y2, pixels);

      grxunlock();

#endif

#else

      cprintf("%c",'0');      

#endif

      task_endcycle();

    }

    break;

    //if (!loop) break;

    //RewindMPEG (mpeg, img);

    //SetMPEGOption (img, MPEG_DITHER, GRAY_DITHER);

    //moreframes = TRUE;

  }

  return NULL;

}

int gvideo_init(char *title, struct gvideoinfo *ptr)

{

  //  static int      groupcounter=0;

  struct info     *info;

  SOFT_TASK_MODEL model;

  FILE            *fin;

  PID             pid,pid2;

  ImageDesc       *img;

  int             res;

  int             i;

  int             period,wcet;

  int             group;

  img=(ImageDesc*)malloc(sizeof(ImageDesc));

  if (img==NULL) return -3;

  img->vid_stream=NULL;

  img->Colormap=NULL;

  info=(struct info*)malloc(sizeof(struct info));

  if (info==NULL) return -11;

  info->img=img;

  info->x=ptr->x;

  info->y=ptr->y;

  fin=fopen(ptr->pathname, "r");  

  if (!fin) return -1;

  //group=STARTGROUP+groupcounter++;

  group=STARTGROUP;

  pid2=x_initbuffer(group,fin,ptr->bitrate,ptr->band*READRATE);

  if (pid2<0) return -2;

#ifdef ACTIVATE

  gbuffer_init(table[fileno(fin)],group,20+12,450);

#else

  gbuffer_init(NULL,group,20+12,450);

#endif

  res=OpenMPEG(fin,img);

  if (!res) return -4;

#ifdef FULLCOLOR  

  SetMPEGOption(img,MPEG_DITHER,HALF_COLOR_DITHER);

#else

  SetMPEGOption(img,MPEG_DITHER,GRAY_DITHER);

#endif  

  //cprintf("colrmap size=%8i\n",img->ColormapSize);

  //cprintf("picture rate=%8i\n",img->PictureRate);

  //cprintf("bit rate    =%8i\n",img->BitRate);

#ifndef FULLCOLOR

  if (group==STARTGROUP) {

    ColormapEntry *cp;

    cp=img->Colormap;

    for (i=0;i<img->ColormapSize;i++) {

#ifndef NOGRX

      grxlock();

      grx_setcolor (i,img->Colormap[i].red/4,

                    img->Colormap[i].green/4,

                    img->Colormap[i].blue/4);

      grxunlock();

#endif    

    }

  }

#endif

  draw_frame(info->x,info->y,img->Width,img->Height);

  ptr->w=img->Width;

  ptr->h=img->Height;

  {

    char buffer[256];

#ifndef NOGRX

    grxlock();

    grx_text(title,ptr->x,ptr->y-14,COLORFG,COLORBG);

    grxunlock();

    sprintf(buffer,"Average bit rate: %i.%03i Mb/s",

            ptr->bitrate/1024/1024,(ptr->bitrate%(1024*1024))*1000/1024/1000);

    grxlock();

    grx_text(buffer,ptr->x,ptr->y+ptr->h+BO*2+2,COLORFG,COLORBG);

    grxunlock();

    sprintf(buffer,"Frame rate      : %02.3f frame/sec",

            (double)ptr->framerate/100.0);

    grxlock();

    grx_text(buffer,ptr->x,ptr->y+ptr->h+BO*2+2+9,COLORFG,COLORBG);

    grxunlock();

#endif

  }

  period=100000000/ptr->framerate;

  wcet=period*ptr->band*VIDEORATE/10000;

  soft_task_default_model(model);        

  soft_task_def_met(model,wcet);

  soft_task_def_wcet(model,wcet);

  soft_task_def_period(model,period);

  soft_task_def_periodic(model);

  soft_task_def_arg(model,(void*)info);

  soft_task_def_group(model,group);

  soft_task_def_ctrl_jet(model);

  pid=task_create("Video",play,&model,NULL);

  if (pid==-1) return -6;

  return group;

}