static int determine_norm(struct i2c_client *client) { DEFINE_WAIT(wait); struct saa7110 *decoder = i2c_get_clientdata(client); int status; /* mode changed, start automatic detection */ saa7110_write_block(client, initseq, sizeof(initseq)); saa7110_selmux(client, decoder->input); prepare_to_wait(&decoder->wq, &wait, TASK_UNINTERRUPTIBLE); schedule_timeout(msecs_to_jiffies(250)); finish_wait(&decoder->wq, &wait); status = saa7110_read(client); if (status & 0x40) { v4l_dbg(1, debug, client, "status=0x%02x (no signal)\n", status); return decoder->norm; // no change } if ((status & 3) == 0) { saa7110_write(client, 0x06, 0x83); if (status & 0x20) { v4l_dbg(1, debug, client, "status=0x%02x (NTSC/no color)\n", status); //saa7110_write(client,0x2E,0x81); return VIDEO_MODE_NTSC; } v4l_dbg(1, debug, client, "status=0x%02x (PAL/no color)\n", status); //saa7110_write(client,0x2E,0x9A); return VIDEO_MODE_PAL; } //saa7110_write(client,0x06,0x03); if (status & 0x20) { /* 60Hz */ v4l_dbg(1, debug, client, "status=0x%02x (NTSC)\n", status); saa7110_write(client, 0x0D, 0x86); saa7110_write(client, 0x0F, 0x50); saa7110_write(client, 0x11, 0x2C); //saa7110_write(client,0x2E,0x81); return VIDEO_MODE_NTSC; } /* 50Hz -> PAL/SECAM */ saa7110_write(client, 0x0D, 0x86); saa7110_write(client, 0x0F, 0x10); saa7110_write(client, 0x11, 0x59); //saa7110_write(client,0x2E,0x9A); prepare_to_wait(&decoder->wq, &wait, TASK_UNINTERRUPTIBLE); schedule_timeout(msecs_to_jiffies(250)); finish_wait(&decoder->wq, &wait); status = saa7110_read(client); if ((status & 0x03) == 0x01) { v4l_dbg(1, debug, client, "status=0x%02x (SECAM)\n", status); saa7110_write(client, 0x0D, 0x87); return VIDEO_MODE_SECAM; } v4l_dbg(1, debug, client, "status=0x%02x (PAL)\n", status); return VIDEO_MODE_PAL; }
static int determine_norm(struct i2c_device* dev) { struct saa7110* decoder = dev->data; int status; /* mode changed, start automatic detection */ status = saa7110_read(decoder); if ((status & 3) == 0) { saa7110_write(decoder,0x06,0x80); if (status & 0x20) { DEBUG(printk(KERN_INFO "%s: norm=bw60\n",dev->name)); saa7110_write(decoder,0x2E,0x81); return VIDEO_MODE_NTSC; } DEBUG(printk(KERN_INFO "%s: norm=bw50\n",dev->name)); saa7110_write(decoder,0x2E,0x9A); return VIDEO_MODE_PAL; } saa7110_write(decoder,0x06,0x00); if (status & 0x20) { /* 60Hz */ DEBUG(printk(KERN_INFO "%s: norm=ntsc\n",dev->name)); saa7110_write(decoder,0x0D,0x06); saa7110_write(decoder,0x11,0x2C); saa7110_write(decoder,0x2E,0x81); return VIDEO_MODE_NTSC; } /* 50Hz -> PAL/SECAM */ saa7110_write(decoder,0x0D,0x06); saa7110_write(decoder,0x11,0x59); saa7110_write(decoder,0x2E,0x9A); mdelay(150); /* pause 150 ms */ status = saa7110_read(decoder); if ((status & 0x03) == 0x01) { DEBUG(printk(KERN_INFO "%s: norm=secam\n",dev->name)); saa7110_write(decoder,0x0D,0x07); return VIDEO_MODE_SECAM; } DEBUG(printk(KERN_INFO "%s: norm=pal\n",dev->name)); return VIDEO_MODE_PAL; }
static int saa7110_attach(struct i2c_device *device) { static const unsigned char initseq[] = { 0, 0x4C, 0x3C, 0x0D, 0xEF, 0xBD, 0xF0, 0x00, 0x00, 0xF8, 0xF8, 0x60, 0x60, 0x00, 0x06, 0x18, 0x90, 0x00, 0x2C, 0x40, 0x46, 0x42, 0x1A, 0xFF, 0xDA, 0xF0, 0x8B, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xD9, 0x17, 0x40, 0x41, 0x80, 0x41, 0x80, 0x4F, 0xFE, 0x01, 0xCF, 0x0F, 0x03, 0x01, 0x81, 0x03, 0x40, 0x75, 0x01, 0x8C, 0x03 }; struct saa7110* decoder; int rv; device->data = decoder = kmalloc(sizeof(struct saa7110), GFP_KERNEL); if (device->data == 0) return -ENOMEM; MOD_INC_USE_COUNT; /* clear our private data */ memset(decoder, 0, sizeof(struct saa7110)); strcpy(device->name, "saa7110"); decoder->bus = device->bus; decoder->addr = device->addr; decoder->norm = VIDEO_MODE_PAL; decoder->input = 0; decoder->enable = 1; decoder->bright = 32768; decoder->contrast = 32768; decoder->hue = 32768; decoder->sat = 32768; rv = saa7110_write_block(decoder, initseq, sizeof(initseq)); if (rv < 0) printk(KERN_ERR "%s_attach: init status %d\n", device->name, rv); else { saa7110_write(decoder,0x21,0x16); saa7110_write(decoder,0x0D,0x04); DEBUG(printk(KERN_INFO "%s_attach: chip version %x\n", device->name, saa7110_read(decoder))); saa7110_write(decoder,0x0D,0x06); } /* setup and implicit mode 0 select has been performed */ return 0; }
static int saa7110_command (struct i2c_client *client, unsigned int cmd, void *arg) { struct saa7110 *decoder = i2c_get_clientdata(client); int v; switch (cmd) { case 0: //saa7110_write_block(client, initseq, sizeof(initseq)); break; case DECODER_GET_CAPABILITIES: { struct video_decoder_capability *dc = arg; dc->flags = VIDEO_DECODER_PAL | VIDEO_DECODER_NTSC | VIDEO_DECODER_SECAM | VIDEO_DECODER_AUTO; dc->inputs = SAA7110_MAX_INPUT; dc->outputs = SAA7110_MAX_OUTPUT; } break; case DECODER_GET_STATUS: { int status; int res = 0; status = saa7110_read(client); dprintk(1, KERN_INFO "%s: status=0x%02x norm=%d\n", I2C_NAME(client), status, decoder->norm); if (!(status & 0x40)) res |= DECODER_STATUS_GOOD; if (status & 0x03) res |= DECODER_STATUS_COLOR; switch (decoder->norm) { case VIDEO_MODE_NTSC: res |= DECODER_STATUS_NTSC; break; case VIDEO_MODE_PAL: res |= DECODER_STATUS_PAL; break; case VIDEO_MODE_SECAM: res |= DECODER_STATUS_SECAM; break; } *(int *) arg = res; } break; case DECODER_SET_NORM: v = *(int *) arg; if (decoder->norm != v) { decoder->norm = v; //saa7110_write(client, 0x06, 0x03); switch (v) { case VIDEO_MODE_NTSC: saa7110_write(client, 0x0D, 0x86); saa7110_write(client, 0x0F, 0x50); saa7110_write(client, 0x11, 0x2C); //saa7110_write(client, 0x2E, 0x81); dprintk(1, KERN_INFO "%s: switched to NTSC\n", I2C_NAME(client)); break; case VIDEO_MODE_PAL: saa7110_write(client, 0x0D, 0x86); saa7110_write(client, 0x0F, 0x10); saa7110_write(client, 0x11, 0x59); //saa7110_write(client, 0x2E, 0x9A); dprintk(1, KERN_INFO "%s: switched to PAL\n", I2C_NAME(client)); break; case VIDEO_MODE_SECAM: saa7110_write(client, 0x0D, 0x87); saa7110_write(client, 0x0F, 0x10); saa7110_write(client, 0x11, 0x59); //saa7110_write(client, 0x2E, 0x9A); dprintk(1, KERN_INFO "%s: switched to SECAM\n", I2C_NAME(client)); break; case VIDEO_MODE_AUTO: dprintk(1, KERN_INFO "%s: TV standard detection...\n", I2C_NAME(client)); decoder->norm = determine_norm(client); *(int *) arg = decoder->norm; break; default: return -EPERM; } } break; case DECODER_SET_INPUT: v = *(int *) arg; if (v < 0 || v > SAA7110_MAX_INPUT) { dprintk(1, KERN_INFO "%s: input=%d not available\n", I2C_NAME(client), v); return -EINVAL; } if (decoder->input != v) { saa7110_selmux(client, v); dprintk(1, KERN_INFO "%s: switched to input=%d\n", I2C_NAME(client), v); } break; case DECODER_SET_OUTPUT: v = *(int *) arg; /* not much choice of outputs */ if (v != 0) return -EINVAL; break; case DECODER_ENABLE_OUTPUT: v = *(int *) arg; if (decoder->enable != v) { decoder->enable = v; saa7110_write(client, 0x0E, v ? 0x18 : 0x80); dprintk(1, KERN_INFO "%s: YUV %s\n", I2C_NAME(client), v ? "on" : "off"); } break; case DECODER_SET_PICTURE: { struct video_picture *pic = arg; if (decoder->bright != pic->brightness) { /* We want 0 to 255 we get 0-65535 */ decoder->bright = pic->brightness; saa7110_write(client, 0x19, decoder->bright >> 8); } if (decoder->contrast != pic->contrast) { /* We want 0 to 127 we get 0-65535 */ decoder->contrast = pic->contrast; saa7110_write(client, 0x13, decoder->contrast >> 9); } if (decoder->sat != pic->colour) { /* We want 0 to 127 we get 0-65535 */ decoder->sat = pic->colour; saa7110_write(client, 0x12, decoder->sat >> 9); }