402 строки
11 KiB
C
402 строки
11 KiB
C
/*
|
|
dpc7146.c - v4l2 driver for the dpc7146 demonstration board
|
|
|
|
Copyright (C) 2000-2003 Michael Hunold <michael@mihu.de>
|
|
|
|
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., 675 Mass Ave, Cambridge, MA 02139, USA.
|
|
*/
|
|
|
|
#define DEBUG_VARIABLE debug
|
|
|
|
#include <media/saa7146_vv.h>
|
|
#include <linux/video_decoder.h> /* for saa7111a */
|
|
|
|
#define I2C_SAA7111A 0x24
|
|
|
|
/* All unused bytes are reserverd. */
|
|
#define SAA711X_CHIP_VERSION 0x00
|
|
#define SAA711X_ANALOG_INPUT_CONTROL_1 0x02
|
|
#define SAA711X_ANALOG_INPUT_CONTROL_2 0x03
|
|
#define SAA711X_ANALOG_INPUT_CONTROL_3 0x04
|
|
#define SAA711X_ANALOG_INPUT_CONTROL_4 0x05
|
|
#define SAA711X_HORIZONTAL_SYNC_START 0x06
|
|
#define SAA711X_HORIZONTAL_SYNC_STOP 0x07
|
|
#define SAA711X_SYNC_CONTROL 0x08
|
|
#define SAA711X_LUMINANCE_CONTROL 0x09
|
|
#define SAA711X_LUMINANCE_BRIGHTNESS 0x0A
|
|
#define SAA711X_LUMINANCE_CONTRAST 0x0B
|
|
#define SAA711X_CHROMA_SATURATION 0x0C
|
|
#define SAA711X_CHROMA_HUE_CONTROL 0x0D
|
|
#define SAA711X_CHROMA_CONTROL 0x0E
|
|
#define SAA711X_FORMAT_DELAY_CONTROL 0x10
|
|
#define SAA711X_OUTPUT_CONTROL_1 0x11
|
|
#define SAA711X_OUTPUT_CONTROL_2 0x12
|
|
#define SAA711X_OUTPUT_CONTROL_3 0x13
|
|
#define SAA711X_V_GATE_1_START 0x15
|
|
#define SAA711X_V_GATE_1_STOP 0x16
|
|
#define SAA711X_V_GATE_1_MSB 0x17
|
|
#define SAA711X_TEXT_SLICER_STATUS 0x1A
|
|
#define SAA711X_DECODED_BYTES_OF_TS_1 0x1B
|
|
#define SAA711X_DECODED_BYTES_OF_TS_2 0x1C
|
|
#define SAA711X_STATUS_BYTE 0x1F
|
|
|
|
#define DPC_BOARD_CAN_DO_VBI(dev) (dev->revision != 0)
|
|
|
|
static int debug = 0;
|
|
module_param(debug, int, 0);
|
|
MODULE_PARM_DESC(debug, "debug verbosity");
|
|
|
|
static int dpc_num = 0;
|
|
|
|
#define DPC_INPUTS 2
|
|
static struct v4l2_input dpc_inputs[DPC_INPUTS] = {
|
|
{ 0, "Port A", V4L2_INPUT_TYPE_CAMERA, 2, 0, V4L2_STD_PAL_BG|V4L2_STD_NTSC_M, 0 },
|
|
{ 1, "Port B", V4L2_INPUT_TYPE_CAMERA, 2, 0, V4L2_STD_PAL_BG|V4L2_STD_NTSC_M, 0 },
|
|
};
|
|
|
|
#define DPC_AUDIOS 0
|
|
|
|
static struct saa7146_extension_ioctls ioctls[] = {
|
|
{ VIDIOC_G_INPUT, SAA7146_EXCLUSIVE },
|
|
{ VIDIOC_S_INPUT, SAA7146_EXCLUSIVE },
|
|
{ VIDIOC_ENUMINPUT, SAA7146_EXCLUSIVE },
|
|
{ VIDIOC_S_STD, SAA7146_AFTER },
|
|
{ 0, 0 }
|
|
};
|
|
|
|
struct dpc
|
|
{
|
|
struct video_device *video_dev;
|
|
struct video_device *vbi_dev;
|
|
|
|
struct i2c_adapter i2c_adapter;
|
|
struct i2c_client *saa7111a;
|
|
|
|
int cur_input; /* current input */
|
|
};
|
|
|
|
/* fixme: add vbi stuff here */
|
|
static int dpc_probe(struct saa7146_dev* dev)
|
|
{
|
|
struct dpc* dpc = NULL;
|
|
struct i2c_client *client;
|
|
struct list_head *item;
|
|
|
|
dpc = (struct dpc*)kmalloc(sizeof(struct dpc), GFP_KERNEL);
|
|
if( NULL == dpc ) {
|
|
printk("dpc_v4l2.o: dpc_probe: not enough kernel memory.\n");
|
|
return -ENOMEM;
|
|
}
|
|
memset(dpc, 0x0, sizeof(struct dpc));
|
|
|
|
/* FIXME: enable i2c-port pins, video-port-pins
|
|
video port pins should be enabled here ?! */
|
|
saa7146_write(dev, MC1, (MASK_08 | MASK_24 | MASK_10 | MASK_26));
|
|
|
|
dpc->i2c_adapter = (struct i2c_adapter) {
|
|
.class = I2C_CLASS_TV_ANALOG,
|
|
.name = "dpc7146",
|
|
};
|
|
saa7146_i2c_adapter_prepare(dev, &dpc->i2c_adapter, SAA7146_I2C_BUS_BIT_RATE_480);
|
|
if(i2c_add_adapter(&dpc->i2c_adapter) < 0) {
|
|
DEB_S(("cannot register i2c-device. skipping.\n"));
|
|
kfree(dpc);
|
|
return -EFAULT;
|
|
}
|
|
|
|
/* loop through all i2c-devices on the bus and look who is there */
|
|
list_for_each(item,&dpc->i2c_adapter.clients) {
|
|
client = list_entry(item, struct i2c_client, list);
|
|
if( I2C_SAA7111A == client->addr )
|
|
dpc->saa7111a = client;
|
|
}
|
|
|
|
/* check if all devices are present */
|
|
if( 0 == dpc->saa7111a ) {
|
|
DEB_D(("dpc_v4l2.o: dpc_attach failed for this device.\n"));
|
|
i2c_del_adapter(&dpc->i2c_adapter);
|
|
kfree(dpc);
|
|
return -ENODEV;
|
|
}
|
|
|
|
/* all devices are present, probe was successful */
|
|
DEB_D(("dpc_v4l2.o: dpc_probe succeeded for this device.\n"));
|
|
|
|
/* we store the pointer in our private data field */
|
|
dev->ext_priv = dpc;
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* bring hardware to a sane state. this has to be done, just in case someone
|
|
wants to capture from this device before it has been properly initialized.
|
|
the capture engine would badly fail, because no valid signal arrives on the
|
|
saa7146, thus leading to timeouts and stuff. */
|
|
static int dpc_init_done(struct saa7146_dev* dev)
|
|
{
|
|
struct dpc* dpc = (struct dpc*)dev->ext_priv;
|
|
|
|
DEB_D(("dpc_v4l2.o: dpc_init_done called.\n"));
|
|
|
|
/* initialize the helper ics to useful values */
|
|
i2c_smbus_write_byte_data(dpc->saa7111a, 0x00, 0x11);
|
|
|
|
i2c_smbus_write_byte_data(dpc->saa7111a, 0x02, 0xc0);
|
|
i2c_smbus_write_byte_data(dpc->saa7111a, 0x03, 0x30);
|
|
i2c_smbus_write_byte_data(dpc->saa7111a, 0x04, 0x00);
|
|
i2c_smbus_write_byte_data(dpc->saa7111a, 0x05, 0x00);
|
|
i2c_smbus_write_byte_data(dpc->saa7111a, 0x06, 0xde);
|
|
i2c_smbus_write_byte_data(dpc->saa7111a, 0x07, 0xad);
|
|
i2c_smbus_write_byte_data(dpc->saa7111a, 0x08, 0xa8);
|
|
i2c_smbus_write_byte_data(dpc->saa7111a, 0x09, 0x00);
|
|
i2c_smbus_write_byte_data(dpc->saa7111a, 0x0a, 0x80);
|
|
i2c_smbus_write_byte_data(dpc->saa7111a, 0x0b, 0x47);
|
|
i2c_smbus_write_byte_data(dpc->saa7111a, 0x0c, 0x40);
|
|
i2c_smbus_write_byte_data(dpc->saa7111a, 0x0d, 0x00);
|
|
i2c_smbus_write_byte_data(dpc->saa7111a, 0x0e, 0x03);
|
|
|
|
i2c_smbus_write_byte_data(dpc->saa7111a, 0x10, 0xd0);
|
|
i2c_smbus_write_byte_data(dpc->saa7111a, 0x11, 0x1c);
|
|
i2c_smbus_write_byte_data(dpc->saa7111a, 0x12, 0xc1);
|
|
i2c_smbus_write_byte_data(dpc->saa7111a, 0x13, 0x30);
|
|
|
|
i2c_smbus_write_byte_data(dpc->saa7111a, 0x1f, 0x81);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static struct saa7146_ext_vv vv_data;
|
|
|
|
/* this function only gets called when the probing was successful */
|
|
static int dpc_attach(struct saa7146_dev* dev, struct saa7146_pci_extension_data *info)
|
|
{
|
|
struct dpc* dpc = (struct dpc*)dev->ext_priv;
|
|
|
|
DEB_D(("dpc_v4l2.o: dpc_attach called.\n"));
|
|
|
|
/* checking for i2c-devices can be omitted here, because we
|
|
already did this in "dpc_vl42_probe" */
|
|
|
|
saa7146_vv_init(dev,&vv_data);
|
|
if( 0 != saa7146_register_device(&dpc->video_dev, dev, "dpc", VFL_TYPE_GRABBER)) {
|
|
ERR(("cannot register capture v4l2 device. skipping.\n"));
|
|
return -1;
|
|
}
|
|
|
|
/* initialization stuff (vbi) (only for revision > 0 and for extensions which want it)*/
|
|
if( 0 != DPC_BOARD_CAN_DO_VBI(dev)) {
|
|
if( 0 != saa7146_register_device(&dpc->vbi_dev, dev, "dpc", VFL_TYPE_VBI)) {
|
|
ERR(("cannot register vbi v4l2 device. skipping.\n"));
|
|
}
|
|
}
|
|
|
|
i2c_use_client(dpc->saa7111a);
|
|
|
|
printk("dpc: found 'dpc7146 demonstration board'-%d.\n",dpc_num);
|
|
dpc_num++;
|
|
|
|
/* the rest */
|
|
dpc->cur_input = 0;
|
|
dpc_init_done(dev);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int dpc_detach(struct saa7146_dev* dev)
|
|
{
|
|
struct dpc* dpc = (struct dpc*)dev->ext_priv;
|
|
|
|
DEB_EE(("dev:%p\n",dev));
|
|
|
|
i2c_release_client(dpc->saa7111a);
|
|
|
|
saa7146_unregister_device(&dpc->video_dev,dev);
|
|
if( 0 != DPC_BOARD_CAN_DO_VBI(dev)) {
|
|
saa7146_unregister_device(&dpc->vbi_dev,dev);
|
|
}
|
|
saa7146_vv_release(dev);
|
|
|
|
dpc_num--;
|
|
|
|
i2c_del_adapter(&dpc->i2c_adapter);
|
|
kfree(dpc);
|
|
return 0;
|
|
}
|
|
|
|
#ifdef axa
|
|
int dpc_vbi_bypass(struct saa7146_dev* dev)
|
|
{
|
|
struct dpc* dpc = (struct dpc*)dev->ext_priv;
|
|
|
|
int i = 1;
|
|
|
|
/* switch bypass in saa7111a */
|
|
if ( 0 != dpc->saa7111a->driver->command(dpc->saa7111a,SAA711X_VBI_BYPASS, &i)) {
|
|
printk("dpc_v4l2.o: VBI_BYPASS: could not address saa7111a.\n");
|
|
return -1;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
#endif
|
|
|
|
static int dpc_ioctl(struct saa7146_fh *fh, unsigned int cmd, void *arg)
|
|
{
|
|
struct saa7146_dev *dev = fh->dev;
|
|
struct dpc* dpc = (struct dpc*)dev->ext_priv;
|
|
/*
|
|
struct saa7146_vv *vv = dev->vv_data;
|
|
*/
|
|
switch(cmd)
|
|
{
|
|
case VIDIOC_ENUMINPUT:
|
|
{
|
|
struct v4l2_input *i = arg;
|
|
DEB_EE(("VIDIOC_ENUMINPUT %d.\n",i->index));
|
|
|
|
if( i->index < 0 || i->index >= DPC_INPUTS) {
|
|
return -EINVAL;
|
|
}
|
|
|
|
memcpy(i, &dpc_inputs[i->index], sizeof(struct v4l2_input));
|
|
|
|
DEB_D(("dpc_v4l2.o: v4l2_ioctl: VIDIOC_ENUMINPUT %d.\n",i->index));
|
|
return 0;
|
|
}
|
|
case VIDIOC_G_INPUT:
|
|
{
|
|
int *input = (int *)arg;
|
|
*input = dpc->cur_input;
|
|
|
|
DEB_D(("dpc_v4l2.o: VIDIOC_G_INPUT: %d\n",*input));
|
|
return 0;
|
|
}
|
|
case VIDIOC_S_INPUT:
|
|
{
|
|
int input = *(int *)arg;
|
|
|
|
if (input < 0 || input >= DPC_INPUTS) {
|
|
return -EINVAL;
|
|
}
|
|
|
|
dpc->cur_input = input;
|
|
|
|
/* fixme: switch input here, switch audio, too! */
|
|
// saa7146_set_hps_source_and_sync(dev, input_port_selection[input].hps_source, input_port_selection[input].hps_sync);
|
|
printk("dpc_v4l2.o: VIDIOC_S_INPUT: fixme switch input.\n");
|
|
|
|
return 0;
|
|
}
|
|
default:
|
|
/*
|
|
DEB_D(("dpc_v4l2.o: v4l2_ioctl does not handle this ioctl.\n"));
|
|
*/
|
|
return -ENOIOCTLCMD;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int std_callback(struct saa7146_dev* dev, struct saa7146_standard *std)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
static struct saa7146_standard standard[] = {
|
|
{
|
|
.name = "PAL", .id = V4L2_STD_PAL,
|
|
.v_offset = 0x17, .v_field = 288,
|
|
.h_offset = 0x14, .h_pixels = 680,
|
|
.v_max_out = 576, .h_max_out = 768,
|
|
}, {
|
|
.name = "NTSC", .id = V4L2_STD_NTSC,
|
|
.v_offset = 0x16, .v_field = 240,
|
|
.h_offset = 0x06, .h_pixels = 708,
|
|
.v_max_out = 480, .h_max_out = 640,
|
|
}, {
|
|
.name = "SECAM", .id = V4L2_STD_SECAM,
|
|
.v_offset = 0x14, .v_field = 288,
|
|
.h_offset = 0x14, .h_pixels = 720,
|
|
.v_max_out = 576, .h_max_out = 768,
|
|
}
|
|
};
|
|
|
|
static struct saa7146_extension extension;
|
|
|
|
static struct saa7146_pci_extension_data dpc = {
|
|
.ext_priv = "Multimedia eXtension Board",
|
|
.ext = &extension,
|
|
};
|
|
|
|
static struct pci_device_id pci_tbl[] = {
|
|
{
|
|
.vendor = PCI_VENDOR_ID_PHILIPS,
|
|
.device = PCI_DEVICE_ID_PHILIPS_SAA7146,
|
|
.subvendor = 0x0000,
|
|
.subdevice = 0x0000,
|
|
.driver_data = (unsigned long)&dpc,
|
|
}, {
|
|
.vendor = 0,
|
|
}
|
|
};
|
|
|
|
MODULE_DEVICE_TABLE(pci, pci_tbl);
|
|
|
|
static struct saa7146_ext_vv vv_data = {
|
|
.inputs = DPC_INPUTS,
|
|
.capabilities = V4L2_CAP_VBI_CAPTURE,
|
|
.stds = &standard[0],
|
|
.num_stds = sizeof(standard)/sizeof(struct saa7146_standard),
|
|
.std_callback = &std_callback,
|
|
.ioctls = &ioctls[0],
|
|
.ioctl = dpc_ioctl,
|
|
};
|
|
|
|
static struct saa7146_extension extension = {
|
|
.name = "dpc7146 demonstration board",
|
|
.flags = SAA7146_USE_I2C_IRQ,
|
|
|
|
.pci_tbl = &pci_tbl[0],
|
|
.module = THIS_MODULE,
|
|
|
|
.probe = dpc_probe,
|
|
.attach = dpc_attach,
|
|
.detach = dpc_detach,
|
|
|
|
.irq_mask = 0,
|
|
.irq_func = NULL,
|
|
};
|
|
|
|
static int __init dpc_init_module(void)
|
|
{
|
|
if( 0 != saa7146_register_extension(&extension)) {
|
|
DEB_S(("failed to register extension.\n"));
|
|
return -ENODEV;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void __exit dpc_cleanup_module(void)
|
|
{
|
|
saa7146_unregister_extension(&extension);
|
|
}
|
|
|
|
module_init(dpc_init_module);
|
|
module_exit(dpc_cleanup_module);
|
|
|
|
MODULE_DESCRIPTION("video4linux-2 driver for the 'dpc7146 demonstration board'");
|
|
MODULE_AUTHOR("Michael Hunold <michael@mihu.de>");
|
|
MODULE_LICENSE("GPL");
|