#include "config.h"
#include <stdio.h>
#include <ctype.h>
#include <string.h>
#ifdef BINARYFILEMODE
#include <fcntl.h>  /* for setmode() */
#endif
#include <stdlib.h>
#include <time.h>
#if HAVE_UNISTD_H
# include <sys/types.h>
# include <unistd.h>
#endif
#if HAVE_SYS_PARAM_H
# include <sys/param.h>
#else
#define MAXPATHLEN 256
#endif
#include "common.h"
#include "command.h"
#include "command2.h"
#ifdef X68
#include "tty_x68.h"
#else
#ifdef WIN32
#include "tty_w32.h"
#include "getopt.h"
#else
#include "tty.h"
#endif
#endif

#include "common.h"
#include "getuint.h"
#define MAX_PICTURE_NUM 96

#ifdef BINARYFILEMODE
#define WMODE "wb"
#define RMODE "rb"
#else
#define WMODE "w"
#define RMODE "r"
#endif
extern int	optind, opterr;
extern char	*optarg;

int	verbose = 0;
static int     speed = 0;
static int format = PPM_P;

static	int	errflg = 0;
static	int	all_pic_num = -1;
#ifndef DONTCAREUID
static	uid_t	uid, euid;
static	gid_t	gid, egid;
static	int	uidswapped = 0;
#endif
static u_char	buf[YCC_MAXSIZ];

void usage()
{
  static	char	*usagestr[] =  {
    "qvrec (Ver 0.10) (c)1996 ken-ichi HAYASHI, itojun\n",
    "qvrec [options] filename1.cam filename2.cam ...\n",
    "\t -h           : show this usage.\n",
#if defined(__linux__) || defined(WIN32)
    "\t -S speed     : serial speed. [normal middle high top light]\n",
#else
    "\t -S speed     : serial speed. [normal middle high]\n",
#endif
#ifndef X68
    "\t -D ttydevice : set tty(cua) device.\n",
#endif
    (char *)NULL,
  };
  char	**p;

  p = usagestr;
  while (*p)
    fprintf(stderr, *p++);
}

void Exit(code)
     int code;
{
  QVchangespeed(DEFAULT);
  QVreset(1);
  if (!(QVgetfd() < 0))
    closetty(QVgetfd());
  exit(code);
} 

void
put_cam(n, infilename)
     int n;
     char *infilename;
{
  int	len;
  FILE	*infp;
  int i;
  int j;
  u_short s;
  u_short id;
  u_int length = 0;
  int skip = 0;
  u_char *u;
  u_char lbuf[16];
  u_char magic[4] = { 0x07, 0x20, 0x4d, 0x4d };

  infp = stdin;
  if (infilename) {
    infp = fopen(infilename, RMODE);
    if (infp == NULL){
      fprintf(stderr, "can't open infile(%s).\n", infilename);
      errflg ++;
      goto cleanup;
    }
  }

  if(fread(lbuf, sizeof(u_char), 4, infp) < 0 ){
    fprintf(stderr, "can't read header.\n");
    errflg ++;
    goto cleanup;
  }
  if(memcmp(lbuf, magic, sizeof(magic)) != 0){
    fprintf(stderr, "this file(%s) is not CAM format.\n", infilename);
    errflg ++;
    goto cleanup;
  }
  if(fread(lbuf, sizeof(u_char), 2, infp) < 0 ){
    fprintf(stderr, "can't read area count.\n");
    errflg ++;
    goto cleanup;
  }

  s = get_u_short(lbuf);
  for(i = 0; i< s ; i++){
    if(fread(lbuf, sizeof(u_char), 16, infp) < 0 ){
      fprintf(stderr, "can't read area id and length.\n");
      errflg ++;
      goto cleanup;
    }

    id = get_u_short(lbuf);
    if( id == 3 ){
      length = get_u_int(lbuf +2);
      break;
    }
    skip = skip + (int) get_u_int(lbuf +2);
  }
  
  while(skip > 0){
    i = fread(buf, sizeof(u_char), (( skip > 256 ) ? 256 : skip), infp);
    if(i < 0){
      fprintf(stderr, "can't skip.\n");
      errflg ++;
      goto cleanup;
    }
    skip = skip - i ;
  }

  u = buf;
  for(i = 0 ; i < (int) length ; i++){
    j = fgetc(infp);
    if(j < 0) {
      perror("fgetc");
      errflg ++;
      goto cleanup;
    }
    buf[i] = (u_char) j;
  }

  len = QVputcam(n, length, buf);

  if (len < 0) {
    errflg ++;
  }

 cleanup:;
  if (infp != stdin)
    fclose(infp);

  return;
}

void
skip_space(infp)
     FILE *infp;
{
  int c;
  c = ' ';
  while(isspace(c)){
    c = fgetc(infp);
  }
  if(c == EOF)
    return;
  ungetc(c, infp);
}

int fgetline(s, size, infp)
     char *s;
     int size;
     FILE *infp;
{
  int i;
  int c;
 fgetretry:
  skip_space(infp);
  for(i = 0 ; i < size; i++){
    c = fgetc(infp);
    if(c == EOF)
      return(EOF);
    if(isspace(c)){
      s[i] = '\0';
      skip_space(infp);
      return(i);
    }else if ( c == '#') {
      while(fgetc(infp) != '\n');
      s[i] = '\0';
      if(i == 0) goto fgetretry;
      return(i);
    }else
      s[i] = c;
  }
  return(i);
}

#define NORM(x) { if(x<0) x=0; else if (x>255) x=255;}
void
put_ppm(n, infilename, skiphead)
     int n;
     char *infilename;
     int skiphead;
{
  int	len;
  FILE	*infp;

  int x, y;
  u_char *Y;
  u_char *Cr;
  u_char *Cb;
  int r, g, b;
  long L;
  long cr, cb;
  int i, j;

  u_char lbuf[256];
  u_char magic[2] = { 'P', '6' };

  int R[PICTURE_WIDTH / 3];
  int G[PICTURE_WIDTH / 3];
  int B[PICTURE_WIDTH / 3];

  infp = stdin;
  if (infilename) {
    infp = fopen(infilename, RMODE);
    if (infp == NULL){
      fprintf(stderr, "can't open infile(%s).\n", infilename);
      errflg ++;
      goto cleanup;
    }
  }

  if(!skiphead){
    if(fgetline(lbuf, 3, infp) < 0 ){
      fprintf(stderr, "can't read header.\n");
      errflg ++;
      goto cleanup;
    }

    if(memcmp(lbuf, magic, sizeof(magic)) != 0){
      fprintf(stderr, "this file(%s) is not PPM(P6) format.\n", infilename);
      errflg ++;
      goto cleanup;
    }

    if(fgetline(lbuf, sizeof(lbuf), infp) < 0 ){
      fprintf(stderr, "can't read width data.\n");
      errflg ++;
      goto cleanup;
    }

    if(strcmp((char *) lbuf, "480") != 0){
      fprintf(stderr, "this picture's width is not 480.\n");
      errflg ++;
      goto cleanup;
    }

    if(fgetline(lbuf, sizeof(lbuf), infp) < 0 ){
      fprintf(stderr, "can't read height data.\n");
      errflg ++;
      goto cleanup;
    }

    if(strcmp((char *) lbuf, "240") != 0){
      fprintf(stderr, "this picture's width is not 240.\n");
      errflg ++;
      goto cleanup;
    }

    if(fgetline(lbuf, sizeof(lbuf), infp) < 0 ){
      fprintf(stderr, "can't read color depth data.\n");
      errflg ++;
      goto cleanup;
    }

    if(strcmp((char *)lbuf, "255") != 0){
      fprintf(stderr, "this picture's depth is not 255.\n");
      errflg ++;
      goto cleanup;
    }

    skip_space(infp);
  }

  Y = buf;
  Cb = Y + (PICTURE_WIDTH * PICTURE_HEIGHT);
  Cr = Cb + (PICTURE_WIDTH /3  * PICTURE_HEIGHT /2 );

  memset(R, 0, sizeof(R));
  memset(G, 0, sizeof(G));
  memset(B, 0, sizeof(B));

  j = 0;
  for(y = 0 ; y < PICTURE_HEIGHT ; y++){
    for( x = 0 ; x < PICTURE_WIDTH ; x++){
      r = fgetc(infp);
      g = fgetc(infp);
      b = fgetc(infp);
      if((r < 0) || (g < 0) || (b < 0)) {
	perror("fgetc");
	errflg ++;
	goto cleanup;
      }
      
      L = (r * 29900 + g * 58700 +  b * 11400 ) / 100000;
      NORM(L);
      Y[PICTURE_WIDTH * y + x ] = (unsigned char) L;
      
      R[x/3] = R[x/3] + r;
      G[x/3] = G[x/3] + g;
      B[x/3] = B[x/3] + b;
    }
    if(y % 2 == 1 ){
      for( i = 0 ; i < PICTURE_WIDTH /3 ; i++){
	r = R[i] / 6 ;
	g = G[i] / 6 ;
	b = B[i] / 6 ;

	cb = (50000 * b -16874 * r - 33126 * g ) / 100000;
	if(cb < 0 ) cb = cb + 256;
	NORM(cb);
	cr = (50000 * r -41869 * g - 8131 * b ) / 100000;
	if(cr < 0 ) cr = cr + 256;
	NORM(cr);
	Cb[ PICTURE_WIDTH /3 * j + i] = (unsigned char) cb;
	Cr[ PICTURE_WIDTH /3 * j + i] = (unsigned char) cr;
	R[i] = 0;
	G[i] = 0;
	B[i] = 0;
      }
      j++;
    }
  }

  len = QVputpicture(n, PICTURE_WIDTH * PICTURE_HEIGHT +
		     PICTURE_WIDTH / 3 * PICTURE_HEIGHT / 2 * 2 , buf);

  if (len < 0) {
    errflg ++;
  }

 cleanup:;
  if (infp != stdin)
    fclose(infp);

  return;
}

#ifndef DONTCAREUID
void
daemonuid()
{
  if (uidswapped) {
#ifdef HAVE_SETREUID
    setreuid(uid, euid);
    setregid(gid, egid);
#else
    setuid(uid);
    seteuid(euid);
    setgid(gid);
    setegid(egid);
#endif
    uidswapped = 0;
  }
}

void
useruid()
{
  if (!uidswapped) {
#ifdef HAVE_SETREUID
    setregid(egid, gid);
    setreuid(euid, uid);
#else
    setgid(egid);
    setegid(gid);
    setuid(euid);
    seteuid(uid);
#endif
    uidswapped = 1;
  }
}
#endif

void
main(argc, argv)
     int	argc;
     char	**argv;
{
  char	*devpath = NULL;
  char	*outfilename = NULL;
  int	start_picture = 0;
  int	end_picture = 0;
  int     move_from = 0 ;
  int     move_to = 0 ;
  char	c;

#ifndef DONTCAREUID
  uid = getuid();
  euid = geteuid();
  gid = getgid();
  egid = getegid();
  useruid();
#endif

  devpath = getenv("QVPLAYTTY");

  while ((c = getopt( argc, argv, "D:S:F:hv")) != -1){

    switch(c) {
    case 'h':
    case '?':
      usage();
      Exit(-1);
    case 'v':
      verbose = 1;
      break;
    case 'D':
      devpath = optarg;
      break;
    case 'S':
      switch(optarg[0]){
#if defined(__linux__) || defined(WIN32)
      case 'l':
      case '5':
	speed = LIGHT;
	break;
      case 't':
      case '4':
	speed = TOP;
	break;
#endif
      case 'h':
      case '3':
	speed = HIGH;
	break;
      case 'm':
      case '2':
	speed = MID;
	break;
      default:
	speed = DEFAULT;
	break;
      }
      break;
    case 'F':
      switch(optarg[0]){
      case 'C':
      case 'c':
	format = CAM;
	break;
      case 'R':
      case 'r':
	format = RGB_P;
	break;
      default:
	format = PPM_P;
	break;
      }
      break;
    }
  }

  if(devpath == NULL){
    devpath = strdup(RSPORT);
  }

  if(devpath){
#ifndef DONTCAREUID
    daemonuid();
#endif
    QVsetfd(opentty(devpath));
#ifndef DONTCAREUID
    useruid();
#endif
    if (QVgetfd() < 0)
      Exit(1);
    if (all_pic_num < 0) 
      all_pic_num = QVhowmany();
    if (all_pic_num < 0)
      Exit(1);
  }
  QVchangespeed(speed);
  if(optind == argc){
    if (all_pic_num < 0) Exit(1);
    if(all_pic_num >= MAX_PICTURE_NUM) {
      fprintf(stderr, "MEMORY FULL, QV-10 has %d pictures.\n",
	      MAX_PICTURE_NUM);
      Exit(2);
    }
#ifdef BINARYFILEMODE
#ifdef WIN32
  	_setmode(_fileno(stdin), _O_BINARY);
#else
  	setmode(fileno(stdin), O_BINARY);
#endif
#endif
	switch(format){
	case CAM:
	    put_cam(all_pic_num + 1, NULL);
	    break;
    case RGB_P:
   	    put_ppm(all_pic_num + 1, NULL,1);
   	    break;
	case PPM_P:
	default:
	    put_ppm(all_pic_num + 1, NULL,0);
	    break;
	}
  }
  if(optind < argc){
    while(optind < argc){
      all_pic_num = QVhowmany();
      if (all_pic_num < 0) Exit(1);
      if(all_pic_num >= MAX_PICTURE_NUM) {
	fprintf(stderr, "NO MEMORY, QV-10 has %d pictures.\n",
		MAX_PICTURE_NUM);
	Exit(2);
      }
      switch(format){
      case CAM:
	put_cam(all_pic_num + 1, argv[optind++]);
	break;
      case RGB_P:
	put_ppm(all_pic_num + 1, argv[optind++], 1);
	break;
      case PPM_P:
      default:
	put_ppm(all_pic_num + 1, argv[optind++], 0);
	break;
      }
      QVshowpicture(all_pic_num + 1);
    }
  }

  Exit (errflg ? 1 : 0);
}
