vidixlib.c

linux下的MPEG1

/*
 * vidixlib.c
 * VIDIXLib - Library for VIDeo Interface for *niX
 *   This interface is introduced as universal one to MPEG decoder,
 *   BES == Back End Scaler and YUV2RGB hw accelerators.
 * In the future it may be expanded up to capturing and audio things.
 * Main goal of this this interface imlpementation is providing DGA
 * everywhere where it's possible (unlike X11 and other).
 * Copyright 2002 Nick Kurshev
 * Licence: GPL
 * This interface is based on v4l2, fbvid.h, mga_vid.h projects
 * and personally my ideas.
 * NOTE: This interface is introduces as APP interface.
 * Don't use it for driver.
 * It provides multistreaming. This mean that APP can handle
 * several streams simultaneously. (Example: Video capturing and video
 * playback or capturing, video playback, audio encoding and so on).
*/
#include <stdlib.h>
#include <stdio.h>
#include <errno.h>
#include <string.h>
#include <inttypes.h>

#include <dlfcn.h> /* GLIBC specific. Exists under cygwin too! */
#include <dirent.h>

#include "vidixlib.h"
#include "bswap.h"

#define t_vdl(p) (((vdl_stream_t *)p))

typedef struct vdl_stream_s
{
	void *  handle;
	int	(*get_caps)(vidix_capability_t *);
	int	(*query_fourcc)(vidix_fourcc_t *);
	int	(*config_playback)(vidix_playback_t *);
	int 	(*playback_on)( void );
	int 	(*playback_off)( void );
        /* Functions below can be missed in driver ;) */
	int	(*init)(const char *);
	void    (*destroy)(void);
	int 	(*frame_sel)( unsigned frame_idx );
	int 	(*get_eq)( vidix_video_eq_t * );
	int 	(*set_eq)( const vidix_video_eq_t * );
	int 	(*get_deint)( vidix_deinterlace_t * );
	int 	(*set_deint)( const vidix_deinterlace_t * );
	int 	(*copy_frame)( const vidix_dma_t * );
	int 	(*query_dma)( void );
	int 	(*get_gkey)( vidix_grkey_t * );
	int 	(*set_gkey)( const vidix_grkey_t * );
	int 	(*get_num_fx)( unsigned * );
	int 	(*get_fx)( vidix_oem_fx_t * );
	int 	(*set_fx)( const vidix_oem_fx_t * );
}vdl_stream_t;

static char drv_name[FILENAME_MAX];
static int dl_idx = -1;
/* currently available driver for static linking */
static const char* const drv_snames[] = {
#ifdef VIDIX_BUILD_STATIC
  "genfb_",
  "mach64_",
  "mga_crtc2_",
  "mga_",
  "nvidia_",
  "pm2_",
  "pm3_",
  "radeo_",
  "rage128_",
#endif
  NULL
};

extern unsigned   vdlGetVersion( void )
{
   return VIDIX_VERSION;
}

static void* dlsymm(void* handle, const char* fce)
{
  char b[100];
#if defined(__OpenBSD__) && !defined(__ELF__)
  b[0] = '_';
  b[1] = 0;
#else
  b[0] = 0;
#endif
  if (dl_idx >= 0) strcat(b, drv_snames[dl_idx]);
  strcat(b, fce);
  //printf("Handle %p  %s\n", handle, b);
  return dlsym(handle, b);
}

static int vdl_fill_driver(VDL_HANDLE stream)
{
  t_vdl(stream)->init		= dlsymm(t_vdl(stream)->handle,"vixInit");
  t_vdl(stream)->destroy	= dlsymm(t_vdl(stream)->handle,"vixDestroy");
  t_vdl(stream)->get_caps	= dlsymm(t_vdl(stream)->handle,"vixGetCapability");
  t_vdl(stream)->query_fourcc	= dlsymm(t_vdl(stream)->handle,"vixQueryFourcc");
  t_vdl(stream)->config_playback= dlsymm(t_vdl(stream)->handle,"vixConfigPlayback");
  t_vdl(stream)->playback_on	= dlsymm(t_vdl(stream)->handle,"vixPlaybackOn");
  t_vdl(stream)->playback_off	= dlsymm(t_vdl(stream)->handle,"vixPlaybackOff");
  t_vdl(stream)->frame_sel	= dlsymm(t_vdl(stream)->handle,"vixPlaybackFrameSelect");
  t_vdl(stream)->get_eq	= dlsymm(t_vdl(stream)->handle,"vixPlaybackGetEq");
  t_vdl(stream)->set_eq	= dlsymm(t_vdl(stream)->handle,"vixPlaybackSetEq");
  t_vdl(stream)->get_gkey	= dlsymm(t_vdl(stream)->handle,"vixGetGrKeys");
  t_vdl(stream)->set_gkey	= dlsymm(t_vdl(stream)->handle,"vixSetGrKeys");
  t_vdl(stream)->get_deint	= dlsymm(t_vdl(stream)->handle,"vixPlaybackGetDeint");
  t_vdl(stream)->set_deint	= dlsymm(t_vdl(stream)->handle,"vixPlaybackSetDeint");
  t_vdl(stream)->copy_frame	= dlsymm(t_vdl(stream)->handle,"vixPlaybackCopyFrame");
  t_vdl(stream)->query_dma	= dlsymm(t_vdl(stream)->handle,"vixQueryDMAStatus");
  t_vdl(stream)->get_num_fx	= dlsymm(t_vdl(stream)->handle,"vixQueryNumOemEffects");
  t_vdl(stream)->get_fx		= dlsymm(t_vdl(stream)->handle,"vixGetOemEffect");
  t_vdl(stream)->set_fx		= dlsymm(t_vdl(stream)->handle,"vixSetOemEffect");
  /* check driver viability */
  if(!( t_vdl(stream)->get_caps && t_vdl(stream)->query_fourcc &&
	t_vdl(stream)->config_playback && t_vdl(stream)->playback_on &&
	t_vdl(stream)->playback_off))
  {
    printf("vidixlib: Incomplete driver: some of essential features are missed in it.\n");
    return 0;
  }
  return 1;
}

#ifndef RTLD_GLOBAL
#define RTLD_GLOBAL RTLD_LAZY
#endif
#ifndef RTLD_NOW
#define RTLD_NOW RTLD_LAZY
#endif

static int vdl_probe_driver(VDL_HANDLE stream,const char *path,const char *name,unsigned cap,int verbose)
{
  vidix_capability_t vid_cap;
  unsigned (*_ver)(void);
  int      (*_probe)(int,int);
  int      (*_cap)(vidix_capability_t*);
  strncpy(drv_name,path,sizeof(drv_name));
  drv_name[sizeof(drv_name) - 1] = '\0';
  strncat(drv_name,name,sizeof(drv_name) - strlen(drv_name) - 1);
  if(verbose) printf("vidixlib: PROBING: %s\n",drv_name);

  {
    const char* slash = strrchr(drv_name, '/');
    if (slash) {
      for (dl_idx = 0; drv_snames[dl_idx]; dl_idx++) {
	if (!strncmp(slash + 1, drv_snames[dl_idx], strlen(drv_snames[dl_idx])))
	  break; // locate the name
      }
      if (!drv_snames[dl_idx]) dl_idx = -1;
    }
  }
  if (dl_idx < 0)
    if(!(t_vdl(stream)->handle = dlopen(drv_name,RTLD_LAZY|RTLD_GLOBAL))) {
      if(verbose) printf("vidixlib: %s not driver: %s\n",drv_name,dlerror());
      return 0;
    }
  _ver = dlsymm(t_vdl(stream)->handle,"vixGetVersion");
  _probe = dlsymm(t_vdl(stream)->handle,"vixProbe");
  _cap = dlsymm(t_vdl(stream)->handle,"vixGetCapability");
  if(_ver)
  {
    if((*_ver)() != VIDIX_VERSION)
    {
      if(verbose) printf("vidixlib: %s has wrong version\n",drv_name);
      err:
      dlclose(t_vdl(stream)->handle);
      t_vdl(stream)->handle = 0;
      dl_idx = -1;
      return 0;
     }
  }
  else
  {
    fatal_err:
    if(verbose) printf("vidixlib: %s has no function definition\n",drv_name);
    goto err;
  }
  if(_probe) { if((*_probe)(verbose,PROBE_NORMAL) != 0) goto err; }
  else goto fatal_err;
  if(_cap) { if((*_cap)(&vid_cap) != 0) goto err; }
  else goto fatal_err;
  if((vid_cap.type & cap) != cap)
  {
     if(verbose) printf("vidixlib: Found %s but has no required capability\n",drv_name);
     goto err;
  }
  if(verbose) printf("vidixlib: %s probed o'k\n",drv_name);
  return 1;
}

static int vdl_find_driver(VDL_HANDLE stream,const char *path,unsigned cap,int verbose)
{
  DIR *dstream;
  struct dirent *name;
  int done = 0;
  if(!(dstream = opendir(path))) return 0;
  while(!done)
  {
    name = readdir(dstream);
    if(name)
    {
      if(name->d_name[0] != '.' && strstr(name->d_name, ".so"))
	if(vdl_probe_driver(stream,path,name->d_name,cap,verbose)) break;
    }
    else done = 1;
  }
  closedir(dstream);
  return done?0:1;
}

VDL_HANDLE vdlOpen(const char *path,const char *name,unsigned cap,int verbose)
{
  vdl_stream_t *stream;
  const char *drv_args=NULL;
  int errcode;
  if(!(stream = malloc(sizeof(vdl_stream_t)))) return NULL;
  memset(stream,0,sizeof(vdl_stream_t));
  if(name)
  {
    unsigned (*ver)(void);
    int (*probe)(int,int);
    unsigned version = 0;
    unsigned char *arg_sep;
    arg_sep = strchr(name,':');
    if(arg_sep) { *arg_sep='\0'; drv_args = &arg_sep[1]; }
    strncpy(drv_name,path,sizeof(drv_name));
    drv_name[sizeof(drv_name) - 1] = '\0';
    strncat(drv_name,name,sizeof(drv_name) - strlen(drv_name) - 1);
    {
      const char* slash = strrchr(drv_name, '/');
      if (slash) {
	for (dl_idx = 0; drv_snames[dl_idx]; dl_idx++) {
	  if (!strncmp(slash + 1, drv_snames[dl_idx], strlen(drv_snames[dl_idx])))
	    break; // locate the name
	}
	if (!drv_snames[dl_idx]) dl_idx = -1;
      }
    }
    if (dl_idx < 0)
      if(!(t_vdl(stream)->handle = dlopen(drv_name,RTLD_NOW|RTLD_GLOBAL)))
      {
	if (verbose)
	  printf("vidixlib: dlopen error: %s\n", dlerror());
	err:
          vdlClose(stream);
	  return NULL;
      }
    ver = dlsymm(t_vdl(stream)->handle,"vixGetVersion");
    if(ver) version = (*ver)();
    if(version != VIDIX_VERSION)
      goto err;
    probe = dlsymm(t_vdl(stream)->handle,"vixProbe");
    if(probe) { if((*probe)(verbose,PROBE_FORCE)!=0) goto err; }
    else goto err;
    fill:
    if(!vdl_fill_driver(stream)) goto err;
    goto ok;
  }
  else
    if(vdl_find_driver(stream,path,cap,verbose))
    {
      if(verbose) printf("vidixlib: will use %s driver\n",drv_name);
      goto fill;
    }
    else goto err;
  ok:
  if(t_vdl(stream)->init)
  {
   if(verbose) printf("vidixlib: Attempt to initialize driver at: %p\n",t_vdl(stream)->init);
   if((errcode=t_vdl(stream)->init(drv_args))!=0)
   {
    if(verbose) printf("vidixlib: Can't init driver: %s\n",strerror(errcode));
    goto err;
   }
  }
  if(verbose) printf("vidixlib: '%s'successfully loaded\n",drv_name);
  return stream;
}

void vdlClose(VDL_HANDLE stream)
{
  if(t_vdl(stream)->destroy) t_vdl(stream)->destroy();
  if(t_vdl(stream)->handle) dlclose(t_vdl(stream)->handle);
  memset(stream,0,sizeof(vdl_stream_t)); /* <- it's not stupid */
  free(stream);
  dl_idx = -1;
}

int  vdlGetCapability(VDL_HANDLE handle, vidix_capability_t *cap)
{
  return t_vdl(handle)->get_caps(cap);
}

#define MPLAYER_IMGFMT_RGB (('R'<<24)|('G'<<16)|('B'<<8))
#define MPLAYER_IMGFMT_BGR (('B'<<24)|('G'<<16)|('R'<<8))
#define MPLAYER_IMGFMT_RGB_MASK 0xFFFFFF00

static uint32_t normalize_fourcc(uint32_t fourcc)
{
  if((fourcc & MPLAYER_IMGFMT_RGB_MASK) == (MPLAYER_IMGFMT_RGB|0) ||
     (fourcc & MPLAYER_IMGFMT_RGB_MASK) == (MPLAYER_IMGFMT_BGR|0))
	return bswap_32(fourcc);
  else  return fourcc;
}

int  vdlQueryFourcc(VDL_HANDLE handle,vidix_fourcc_t *f)
{
  f->fourcc = normalize_fourcc(f->fourcc);
  return t_vdl(handle)->query_fourcc(f);
}

int  vdlConfigPlayback(VDL_HANDLE handle,vidix_playback_t *p)
{
  p->fourcc = normalize_fourcc(p->fourcc);
  return t_vdl(handle)->config_playback(p);
}

int  vdlPlaybackOn(VDL_HANDLE handle)
{
  return t_vdl(handle)->playback_on();
}

int  vdlPlaybackOff(VDL_HANDLE handle)
{
  return t_vdl(handle)->playback_off();
}

int  vdlPlaybackFrameSelect(VDL_HANDLE handle, unsigned frame_idx )
{
  return t_vdl(handle)->frame_sel ? t_vdl(handle)->frame_sel(frame_idx) : ENOSYS;
}

int  vdlPlaybackGetEq(VDL_HANDLE handle, vidix_video_eq_t * e)
{
  return t_vdl(handle)->get_eq ? t_vdl(handle)->get_eq(e) : ENOSYS;
}

int  vdlPlaybackSetEq(VDL_HANDLE handle, const vidix_video_eq_t * e)
{
  return t_vdl(handle)->set_eq ? t_vdl(handle)->set_eq(e) : ENOSYS;
}

int  vdlPlaybackCopyFrame(VDL_HANDLE handle, vidix_dma_t * f)
{
  return t_vdl(handle)->copy_frame ? t_vdl(handle)->copy_frame(f) : ENOSYS;
}

int  vdlQueryDMAStatus(VDL_HANDLE handle )
{
  return t_vdl(handle)->query_dma ? t_vdl(handle)->query_dma() : ENOSYS;
}

int 	  vdlGetGrKeys(VDL_HANDLE handle, vidix_grkey_t * k)
{
  return t_vdl(handle)->get_gkey ? t_vdl(handle)->get_gkey(k) : ENOSYS;
}

int 	  vdlSetGrKeys(VDL_HANDLE handle, const vidix_grkey_t * k)
{
  return t_vdl(handle)->set_gkey ? t_vdl(handle)->set_gkey(k) : ENOSYS;
}

int	  vdlPlaybackGetDeint(VDL_HANDLE handle, vidix_deinterlace_t * d)
{
  return t_vdl(handle)->get_deint ? t_vdl(handle)->get_deint(d) : ENOSYS;
}

int 	  vdlPlaybackSetDeint(VDL_HANDLE handle, const vidix_deinterlace_t * d)
{
  return t_vdl(handle)->set_deint ? t_vdl(handle)->set_deint(d) : ENOSYS;
}

int	  vdlQueryNumOemEffects(VDL_HANDLE handle, unsigned * number )
{
  return t_vdl(handle)->get_num_fx ? t_vdl(handle)->get_num_fx(number) : ENOSYS;
}

int	  vdlGetOemEffect(VDL_HANDLE handle, vidix_oem_fx_t * f)
{
  return t_vdl(handle)->get_fx ? t_vdl(handle)->get_fx(f) : ENOSYS;
}

int	  vdlSetOemEffect(VDL_HANDLE handle, const vidix_oem_fx_t * f)
{
  return t_vdl(handle)->set_fx ? t_vdl(handle)->set_fx(f) : ENOSYS;
}

/* ABI related extensions */
vidix_capability_t *	vdlAllocCapabilityS( void )
{
    vidix_capability_t *retval;
    retval=malloc(sizeof(vidix_capability_t));
    if(retval) memset(retval,0,sizeof(vidix_capability_t));
    return retval;
}

vidix_fourcc_t *		vdlAllocFourccS( void )
{
    vidix_fourcc_t *retval;
    retval=malloc(sizeof(vidix_fourcc_t));
    if(retval) memset(retval,0,sizeof(vidix_fourcc_t));
    return retval;
}

vidix_yuv_t *		vdlAllocYUVS( void )
{
    vidix_yuv_t *retval;
    retval=malloc(sizeof(vidix_yuv_t));
    if(retval) memset(retval,0,sizeof(vidix_yuv_t));
    return retval;
}

vidix_rect_t *		vdlAllocRectS( void )
{
    vidix_rect_t *retval;
    retval=malloc(sizeof(vidix_rect_t));
    if(retval) memset(retval,0,sizeof(vidix_rect_t));
    return retval;
}

vidix_playback_t *	vdlAllocPlaybackS( void )
{
    vidix_playback_t *retval;
    retval=malloc(sizeof(vidix_playback_t));
    if(retval) memset(retval,0,sizeof(vidix_playback_t));
    return retval;
}

vidix_grkey_t *		vdlAllocGrKeyS( void )
{
    vidix_grkey_t *retval;
    retval=malloc(sizeof(vidix_grkey_t));
    if(retval) memset(retval,0,sizeof(vidix_grkey_t));
    return retval;
}

vidix_video_eq_t *	vdlAllocVideoEqS( void )
{
    vidix_video_eq_t *retval;
    retval=malloc(sizeof(vidix_video_eq_t));
    if(retval) memset(retval,0,sizeof(vidix_video_eq_t));
    return retval;
}

vidix_deinterlace_t *	vdlAllocDeinterlaceS( void )
{
    vidix_deinterlace_t *retval;
    retval=malloc(sizeof(vidix_deinterlace_t));
    if(retval) memset(retval,0,sizeof(vidix_deinterlace_t));
    return retval;
}

vidix_dma_t *		vdlAllocDmaS( void )
{
    vidix_dma_t *retval;
    retval=malloc(sizeof(vidix_dma_t));
    if(retval) memset(retval,0,sizeof(vidix_dma_t));
    return retval;
}

vidix_oem_fx_t *		vdlAllocOemFxS( void )
{
    vidix_oem_fx_t *retval;
    retval=malloc(sizeof(vidix_oem_fx_t));
    if(retval) memset(retval,0,sizeof(vidix_oem_fx_t));
    return retval;
}

void	vdlFreeCapabilityS(vidix_capability_t * _this) { free(_this); }
void 	vdlFreeFourccS( vidix_fourcc_t * _this ) { free(_this); }
void	vdlFreePlaybackS( vidix_playback_t * _this ) { free(_this); }
void	vdlFreeYUVS( vidix_yuv_t * _this) { free(_this); }
void	vdlFreeRectS( vidix_rect_t * _this) { free(_this); }
void	vdlFreeGrKeyS( vidix_grkey_t * _this) { free(_this); }
void	vdlFreeVideoEqS( vidix_video_eq_t * _this) { free(_this); }
void	vdlFreeDeinterlaceS( vidix_deinterlace_t * _this) { free(_this); }
void	vdlFreeDmaS( vidix_dma_t * _this) { free(_this); }
void	vdlFreeOemFxS( vidix_oem_fx_t * _this) { free(_this); }