Esempio n. 1
0
static int ov76be_set_control(struct i2c_client *c,
			      struct ovcamchip_control *ctl)
{
	struct ovcamchip *ov = i2c_get_clientdata(c);
	struct ov76be *s = ov->spriv;
	int rc;
	int v = ctl->value;

	switch (ctl->id) {
	case OVCAMCHIP_CID_BRIGHT:
		rc = ov_write(c, REG_BRT, v >> 8);
		break;
	case OVCAMCHIP_CID_SAT:
		rc = ov_write(c, REG_SAT, v >> 8);
		break;
	case OVCAMCHIP_CID_EXP:
		rc = ov_write(c, REG_EXP, v);
		break;
	case OVCAMCHIP_CID_FREQ:
	{
		int sixty = (v == 60);

		rc = ov_write_mask(c, 0x2a, sixty?0x00:0x80, 0x80);
		if (rc < 0)
			goto out;

		rc = ov_write(c, 0x2b, sixty?0x00:0xac);
		if (rc < 0)
			goto out;

		rc = ov_write_mask(c, 0x76, 0x01, 0x01);
		break;
	}
	case OVCAMCHIP_CID_BANDFILT:
		rc = ov_write_mask(c, 0x2d, v?0x04:0x00, 0x04);
		s->bandfilt = v;
		break;
	case OVCAMCHIP_CID_AUTOBRIGHT:
		rc = ov_write_mask(c, 0x2d, v?0x10:0x00, 0x10);
		s->auto_brt = v;
		break;
	case OVCAMCHIP_CID_AUTOEXP:
		rc = ov_write_mask(c, 0x13, v?0x01:0x00, 0x01);
		s->auto_exp = v;
		break;
	case OVCAMCHIP_CID_MIRROR:
		rc = ov_write_mask(c, 0x12, v?0x40:0x00, 0x40);
		s->mirror = v;
		break;
	default:
		DDEBUG(2, &c->dev, "control not supported: %d", ctl->id);
		return -EPERM;
	}

out:
	DDEBUG(3, &c->dev, "id=%d, arg=%d, rc=%d", ctl->id, v, rc);
	return rc;
}
Esempio n. 2
0
static int ov6x20_get_control(struct i2c_client *c,
			      struct ovcamchip_control *ctl)
{
	struct ovcamchip *ov = i2c_get_clientdata(c);
	struct ov6x20 *s = ov->spriv;
	int rc = 0;
	unsigned char val = 0;

	switch (ctl->id) {
	case OVCAMCHIP_CID_CONT:
		rc = ov_read(c, REG_CNT, &val);
		ctl->value = val << 8;
		break;
	case OVCAMCHIP_CID_BRIGHT:
		rc = ov_read(c, REG_BRT, &val);
		ctl->value = val << 8;
		break;
	case OVCAMCHIP_CID_SAT:
		rc = ov_read(c, REG_SAT, &val);
		ctl->value = val << 8;
		break;
	case OVCAMCHIP_CID_HUE:
		rc = ov_read(c, REG_BLUE, &val);
		ctl->value = val << 8;
		break;
	case OVCAMCHIP_CID_EXP:
		rc = ov_read(c, REG_EXP, &val);
		ctl->value = val;
		break;
	case OVCAMCHIP_CID_BANDFILT:
		ctl->value = s->bandfilt;
		break;
	case OVCAMCHIP_CID_AUTOBRIGHT:
		ctl->value = s->auto_brt;
		break;
	case OVCAMCHIP_CID_AUTOEXP:
		ctl->value = s->auto_exp;
		break;
	case OVCAMCHIP_CID_BACKLIGHT:
		ctl->value = s->backlight;
		break;
	case OVCAMCHIP_CID_MIRROR:
		ctl->value = s->mirror;
		break;
	default:
		DDEBUG(2, &c->dev, "control not supported: %d", ctl->id);
		return -EPERM;
	}

	DDEBUG(3, &c->dev, "id=%d, arg=%d, rc=%d", ctl->id, ctl->value, rc);
	return rc;
}
Esempio n. 3
0
/* This initializes the OV6x20 camera chip and relevant variables. */
static int ov6x20_init(struct i2c_client *c)
{
	struct ovcamchip *ov = i2c_get_clientdata(c);
	struct ov6x20 *s;
	int rc;

	DDEBUG(4, &c->dev, "entered");

	switch (c->adapter->id) {
	case I2C_ALGO_SMBUS | I2C_HW_SMBUS_OV511:
		rc = ov_write_regvals(c, regvals_init_6x20_511);
		break;
	case I2C_ALGO_SMBUS | I2C_HW_SMBUS_OV518:
		rc = ov_write_regvals(c, regvals_init_6x20_518);
		break;
	default:
		dev_err(&c->dev, "ov6x20: Unsupported adapter\n");
		rc = -ENODEV;
	}

	if (rc < 0)
		return rc;

	ov->spriv = s = kmalloc(sizeof *s, GFP_KERNEL);
	if (!s)
		return -ENOMEM;
	memset(s, 0, sizeof *s);

	s->auto_brt = 1;
	s->auto_exp = 1;

	return rc;
}
Esempio n. 4
0
unsigned long dispatch_gemdos(char * _args)
{
  TOSARG(short, callnum);
  long rv;

  /* Allocate a program structure if needed */
  if (prog == NULL)
  {
    prog = new_program ();
  }

  /* Check for possible MiNT call */
  if (prog->emulate_mint && callnum >= 255)
  {
    rv = dispatch_mint(_args - 2);
  }
  else if (callnum < 0 || callnum > arraysize(gemdos_syscalls) ||
           !gemdos_syscalls[callnum])
  {
    DDEBUG( "call to invalid GEMDOS function #%d\n", callnum );
    rv = TOS_EINVFN;
  }
  else
  {
    STRACE_BEGIN(gemdos, _args);
    rv = gemdos_syscalls[ callnum ](_args);
    STRACE_END( gemdos, _args, rv );
  }

  return rv;
}
Esempio n. 5
0
static int ov76be_command(struct i2c_client *c, unsigned int cmd, void *arg)
{
	switch (cmd) {
	case OVCAMCHIP_CMD_S_CTRL:
		return ov76be_set_control(c, arg);
	case OVCAMCHIP_CMD_G_CTRL:
		return ov76be_get_control(c, arg);
	case OVCAMCHIP_CMD_S_MODE:
		return ov76be_set_window(c, arg);
	default:
		DDEBUG(2, &c->dev, "command not supported: %d", cmd);
		return -ENOIOCTLCMD;
	}
}
Esempio n. 6
0
static int ov76be_init(struct i2c_client *c)
{
	struct ovcamchip *ov = i2c_get_clientdata(c);
	struct ov76be *s;
	int rc;

	DDEBUG(4, &c->dev, "entered");

	rc = ov_write_regvals(c, regvals_init_76be);
	if (rc < 0)
		return rc;

	ov->spriv = s = kzalloc(sizeof *s, GFP_KERNEL);
	if (!s)
		return -ENOMEM;

	s->auto_brt = 1;
	s->auto_exp = 1;

	return rc;
}
Esempio n. 7
0
TosProgram *load_tos_program( char *filename )
{
  TosProgram * prog;
  TosExecHeader *hdr;
  TosBasepage *bp;
  void *prg, *buf;
  ulong size;
  FILE *fp;
  char *env, *src, *dest;
  char ascii_num[ 4 ];

  /* Allocate a new program structure */
  prog = new_program ();

  /* Set up the MiNT emulation flag */
  DDEBUG( "Environment: %s\n", Opt_environment );
  prog->emulate_mint = Opt_MiNT;

  /* Set up GEM flag, if program name ends on .app or .prg
	 and Opt_GEM is not set to "no" */
  /* Use case insensitive compare */
  if(Opt_GEM && (!strncasecmp(filename+strlen(filename)-4, ".app", 4) ||
				 !strncasecmp(filename+strlen(filename)-4, ".prg", 4)))
	prog->gem = 1;
  else
	prog->gem = 0;
  
  /* Set up the environment */
  if( strcmp( Opt_environment, "-" ) == 0 ) {
	env = NULL;
  }
  else
  {
	env = (char *)mymalloc( strlen( Opt_environment ) + 2 );
	for( src = Opt_environment, dest = env ; *src ; src++ ) {
	  if( *src == '\\' ) {
		src++;
		if( *src >= '0' && *src <= '9' ) {
		  ascii_num[ 0 ] = *src++;
		  ascii_num[ 1 ] = *src++;
		  ascii_num[ 2 ] = *src;
		  ascii_num[ 3 ] = 0;
		  *dest++ = strtol( ascii_num, NULL, 8 );
		}
		else {
		  switch( *src ) {
		  case 'n':
			*dest++ = '\n';
			break;
		  case 'r':
			*dest++ = '\r';
			break;
		  default:
			*dest++ = *src;
			break;
		  }
		}
	  }
	  else if( *src == ',' ) {
		*dest++ = '\0';
	  }
	  else {
		*dest++ = *src;
	  }
	}
	*dest++ = 0;
	*dest++ = 0;
  }  

  /* Set up the trace flag */
  prog->trace = Opt_trace;

  if( (fp = fopen( filename, "r" )) == NULL ){
    fprintf( stderr, "Can't open %s: %s\n", filename, strerror(errno) );
    return NULL;
  }

  /* read the header */
  hdr = (TosExecHeader *)mymalloc( sizeof(TosExecHeader) );
  if (fread( hdr, sizeof(TosExecHeader), 1, fp ) != 1 ||
	  ntohs(hdr->magic) != TOS_PROGRAM_MAGIC) {
	fprintf( stderr, "%s: no GEMDOS executable\n", filename );
	free( hdr );
	fclose( fp );
	return NULL;
  }

  /* calculate size of TPA */
  size = sizeof(TosBasepage) + ntohl(hdr->tsize) + ntohl(hdr->dsize) +
    ntohl(hdr->bsize) + Opt_extra_mem*1024;
  buf = (void *)mymalloc( size );
  bp = (TosBasepage *)buf;
  prg = (void *)(bp + 1);

  /* read program text + data */
  if(fread(prg, sizeof(char), ntohl(hdr->tsize) + ntohl(hdr->dsize), fp ) !=
     ntohl(hdr->tsize) + ntohl(hdr->dsize))
  {
	  fprintf( stderr, "%s: short executable!\n", filename );
	err_ret:
	  free( buf );
	  free( hdr );
	  fclose( fp );
	  return NULL;
  }

  /* initialize basepage */
  bp->lowtpa = htonl((UInt32)bp);
  bp->hitpa = htonl((UInt32)buf + size);
  bp->tbase = htonl(TEXT_SEGMENT(hdr,prg));
  bp->tlen = hdr->tsize;
  bp->dbase = htonl(DATA_SEGMENT(hdr,prg));
  bp->dlen = hdr->dsize;
  bp->bbase = htonl(BSS_SEGMENT(hdr,prg));
  bp->blen = hdr->bsize;
  bp->parent = (Ptr32)NULL;
  bp->env = (char *)htonl((UInt32)env);
  bp->cmdlin[ 0 ] = 0;

  /*  patch_program( hdr ); */
  if (relocate_program( bp, hdr, fp ) < 0) {
	  fprintf( stderr, "%s: relocation failed\n", filename );
	  goto err_ret;
  }
  fclose( fp );
  
  /* clear BSS and maybe rest of TPA */
  memset((void *)BSS_SEGMENT(hdr,prg), 0,
         ntohl(hdr->bsize) +
         ((ntohl(hdr->prgflags) & TOS_PRGFLAG_FASTLOAD) ? 0 : Opt_extra_mem*1024) );

  prog->text = TEXT_SEGMENT(hdr,prg);
  prog->data = DATA_SEGMENT(hdr,prg);
  prog->bss = BSS_SEGMENT(hdr,prg);
  prog->size = size;

  prog->basepage = bp;
  prog->basepage->dta = (Dta *)ntohl((UInt32)prog->basepage->cmdlin);
  prog->dta = (Dta *)ntohl((UInt32)prog->basepage->dta);

  /* The program starts in user mode */
  prog->super = 0;
  
  /* The program starts in the TOS domain */
  prog->domain = 0;

#ifdef DEBUG_STACK
  start_stack = BSS_SEGMENT(hdr,prg) + ntohl(hdr->bsize);
#endif

  free(hdr);
  
  return prog;
}