Subversion Repositories shark

Rev

Blame | Last modification | View Log | RSS feed

/*
    saa7111 - Philips SAA7111A video decoder driver version 0.0.3

    Copyright (C) 1998 Dave Perks <dperks@ibm.net>

    Slight changes for video timing and attachment output by
    Wolfgang Scherr <scherr@net4you.net>
   
    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.
*/


#include <linux/module.h>
#include <linux/init.h>
#include <linux/delay.h>
#include <linux/errno.h>
#include <linux/fs.h>
#include <linux/kernel.h>
#include <linux/major.h>
#include <linux/slab.h>
#include <linux/mm.h>
#include <linux/sched.h>

#include <linux/videodev.h>
#include <linux/version.h>
#include <linux/i2c.h>

#include <linux/video_decoder.h>

#define DEBUG(x)                /* Debug driver */

/* ----------------------------------------------------------------------- */

struct saa7111 {
        struct i2c_client *client;
        int addr;
        struct semaphore lock;
        unsigned char reg[32];

        int norm;
        int input;
        int enable;
        int bright;
        int contrast;
        int hue;
        int sat;
};

static unsigned short normal_i2c[] = { 0x24, 0x25, I2C_CLIENT_END };   
static unsigned short normal_i2c_range[] = { I2C_CLIENT_END }; 

I2C_CLIENT_INSMOD;

static struct i2c_client client_template;
/* ----------------------------------------------------------------------- */
static int saa7111_attach(struct i2c_adapter *adap, int addr, unsigned short flags, int kind)
{
        int i;
        struct saa7111 *decoder;
        struct i2c_client *client;

        /* who wrote this? init[] is used for i2c_master_send() which expects an array that
           will be used for the 'buf' part of an i2c message unchanged. so, the first byte
           needs to be the subaddress to start with, then follow the data bytes... */

        static const unsigned char init[] = {
                0x00,     /* start address */
       
                0x00,     /* 00 - ID byte */
                0x00,     /* 01 - reserved */

                /*front end */
                0xd0,     /* 02 - FUSE=3, GUDL=2, MODE=0 */
                0x23,     /* 03 - HLNRS=0, VBSL=1, WPOFF=0, HOLDG=0, GAFIX=0, GAI1=256, GAI2=256 */
                0x00,     /* 04 - GAI1=256 */
                0x00,     /* 05 - GAI2=256 */

                /* decoder */
                0xf3,     /* 06 - HSB at  13(50Hz) /  17(60Hz) pixels after end of last line */
                0x13,     /* 07 - HSS at 113(50Hz) / 117(60Hz) pixels after end of last line */
                0xc8,     /* 08 - AUFD=1, FSEL=1, EXFIL=0, VTRC=1, HPLL=0, VNOI=0 */
                0x01,     /* 09 - BYPS=0, PREF=0, BPSS=0, VBLB=0, UPTCV=0, APER=1 */
                0x80,     /* 0a - BRIG=128 */
                0x47,     /* 0b - CONT=1.109 */
                0x40,     /* 0c - SATN=1.0 */
                0x00,     /* 0d - HUE=0 */
                0x01,     /* 0e - CDTO=0, CSTD=0, DCCF=0, FCTC=0, CHBW=1 */
                0x00,     /* 0f - reserved */
                0x48,     /* 10 - OFTS=1, HDEL=0, VRLN=1, YDEL=0 */
                0x1c,     /* 11 - GPSW=0, CM99=0, FECO=0, COMPO=1, OEYC=1, OEHV=1, VIPB=0, COLO=0 */
                0x00,     /* 12 - output control 2 */
                0x00,     /* 13 - output control 3 */
                0x00,     /* 14 - reserved */
                0x00,     /* 15 - VBI */
                0x00,     /* 16 - VBI */
                0x00,     /* 17 - VBI */
        };
        client = kmalloc(sizeof(*client), GFP_KERNEL);
        if(client == NULL)
                return -ENOMEM;
        client_template.adapter = adap;
        client_template.addr = addr;
        memcpy(client, &client_template, sizeof(*client));

        decoder = kmalloc(sizeof(*decoder), GFP_KERNEL);
        if (decoder == NULL)
        {
                kfree(client);
                return -ENOMEM;
        }

        memset(decoder, 0, sizeof(*decoder));
        decoder->client = client;
#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0))
        client->data = decoder;        
#else
        i2c_set_clientdata(client, decoder);
#endif
        decoder->addr = addr;
        decoder->norm = VIDEO_MODE_NTSC;
        decoder->input = 0;
        decoder->enable = 1;
        decoder->bright = 32768;
        decoder->contrast = 32768;
        decoder->hue = 32768;
        decoder->sat = 32768;

        i = i2c_master_send(client, init, sizeof(init));
        if (i < 0) {
                printk(KERN_ERR "%s_attach: init status %d\n",
#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0))
                       client->name, i);
#else
                       client->dev.name, i);
#endif
        } else {
                printk(KERN_INFO "%s_attach: chip version %x @ 0x%08x\n",
#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0))
                       client->name, i2c_smbus_read_byte_data(client, 0x00) >> 4,addr);
#else
                       client->dev.name, i2c_smbus_read_byte_data(client, 0x00) >> 4,addr);
#endif
        }

        init_MUTEX(&decoder->lock);
        i2c_attach_client(client);
        MOD_INC_USE_COUNT;
        return 0;
}
static int saa7111_probe(struct i2c_adapter *adap)
{
        /* probing unknown devices on any Matrox i2c-bus takes ages due to the
           slow bit banging algorithm used. because of the fact a saa7111(a)
           is *never* present on a Matrox gfx card, we can skip such adapters
           here */

        if( 0 != (adap->id & I2C_HW_B_G400)) {
                return -ENODEV;
        }
       
#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0))
        printk("saa7111: probing %s i2c adapter [id=0x%x]\n",
                       adap->name,adap->id);
#else
        printk("saa7111: probing %s i2c adapter [id=0x%x]\n",
                       adap->dev.name,adap->id);
#endif
        return i2c_probe(adap, &addr_data, saa7111_attach);
}

static int saa7111_detach(struct i2c_client *client)
{
#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0))
        struct saa7111 *decoder = client->data;
#else
        struct saa7111 *decoder = i2c_get_clientdata(client);
#endif
        i2c_detach_client(client);
        kfree(decoder);
        kfree(client);
        MOD_DEC_USE_COUNT;
        return 0;
}

static int saa7111_command(struct i2c_client *client, unsigned int cmd,
                           void *arg)
{
#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0))
        struct saa7111 *decoder = client->data;
#else
        struct saa7111 *decoder = i2c_get_clientdata(client);
#endif
        switch (cmd) {

#if defined(DECODER_DUMP)
        case DECODER_DUMP:
                {
                        int i;

                        for (i = 0; i < 32; i += 16) {
                                int j;

#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0))
                                printk("KERN_DEBUG %s: %03x", client->name,
#else
                                printk("KERN_DEBUG %s: %03x", client->dev.name,
#endif
                                       i);
                                for (j = 0; j < 16; ++j) {
                                        printk(" %02x",
                                               i2c_smbus_read_byte_data(client,
                                                            i + j));
                                }
                                printk("\n");
                        }
                }
                break;
#endif                          /* defined(DECODER_DUMP) */
        case DECODER_GET_CAPABILITIES:
                {
                        struct video_decoder_capability *cap = arg;

                        cap->flags
                            = VIDEO_DECODER_PAL
                            | VIDEO_DECODER_NTSC
                            | VIDEO_DECODER_AUTO | VIDEO_DECODER_CCIR;
                        cap->inputs = 8;
                        cap->outputs = 1;
                }
                break;
        case DECODER_GET_STATUS:
                {
                        int *iarg = arg;
                        int status;
                        int res;

                        status = i2c_smbus_read_byte_data(client, 0x1f);
                        res = 0;
                        if ((status & (1 << 6)) == 0) {
                                res |= DECODER_STATUS_GOOD;
                        }
                        switch (decoder->norm) {
                        case VIDEO_MODE_NTSC:
                                res |= DECODER_STATUS_NTSC;
                                break;
                        case VIDEO_MODE_PAL:
                                res |= DECODER_STATUS_PAL;
                                break;
                        default:
                        case VIDEO_MODE_AUTO:
                                if ((status & (1 << 5)) != 0) {
                                        res |= DECODER_STATUS_NTSC;
                                } else {
                                        res |= DECODER_STATUS_PAL;
                                }
                                break;
                        }
                        if ((status & (1 << 0)) != 0) {
                                res |= DECODER_STATUS_COLOR;
                        }
                        *iarg = res;
                }
                break;

        case DECODER_SET_NORM:
                {
                        int *iarg = arg;

                        switch (*iarg) {

                        case VIDEO_MODE_NTSC:
                                i2c_smbus_write_byte_data(client, 0x08,
                                              (decoder->
                                               reg[0x08] & 0x3f) | 0x40);
                                break;

                        case VIDEO_MODE_PAL:
                                i2c_smbus_write_byte_data(client, 0x08,
                                              (decoder->
                                               reg[0x08] & 0x3f) | 0x00);
                                break;

                        case VIDEO_MODE_AUTO:
                                i2c_smbus_write_byte_data(client, 0x08,
                                              (decoder->
                                               reg[0x08] & 0x3f) | 0x80);
                                break;

                        default:
                                return -EINVAL;

                        }
                        decoder->norm = *iarg;
                }
                break;

        case DECODER_SET_INPUT:
                {
                        int *iarg = arg;

                        if (*iarg < 0 || *iarg > 7) {
                                return -EINVAL;
                        }

                        if (decoder->input != *iarg) {
                                decoder->input = *iarg;
                                /* select mode */
                                i2c_smbus_write_byte_data(client, 0x02,
                                              (decoder->
                                               reg[0x02] & 0xf8) |
                                              decoder->input);
                                /* bypass chrominance trap for modes 4..7 */
                                i2c_smbus_write_byte_data(client, 0x09,
                                              (decoder->
                                               reg[0x09] & 0x7f) |
                                              ((decoder->input >
                                                3) ? 0x80 : 0));
                        }
                }
                break;

        case DECODER_SET_OUTPUT:
                {
                        int *iarg = arg;

                        /* not much choice of outputs */
                        if (*iarg != 0) {
                                return -EINVAL;
                        }
                }
                break;

        case DECODER_ENABLE_OUTPUT:
                {
                        int *iarg = arg;
                        int enable = (*iarg != 0);

                        if (decoder->enable != enable) {
                                decoder->enable = enable;

// RJ: If output should be disabled (for playing videos), we also need a open PLL.
//     The input is set to 0 (where no input source is connected), although this
//     is not necessary.
//
//     If output should be enabled, we have to reverse the above.

                                if (decoder->enable) {
                                        i2c_smbus_write_byte_data(client, 0x02,
                                                      (decoder->
                                                       reg[0x02] & 0xf8) |
                                                      decoder->input);
                                        i2c_smbus_write_byte_data(client, 0x08,
                                                      (decoder->
                                                       reg[0x08] & 0xfb));
                                        i2c_smbus_write_byte_data(client, 0x11,
                                                      (decoder->
                                                       reg[0x11] & 0xf3) |
                                                      0x0c);
                                } else {
                                        i2c_smbus_write_byte_data(client, 0x02,
                                                      (decoder->
                                                       reg[0x02] & 0xf8));
                                        i2c_smbus_write_byte_data(client, 0x08,
                                                      (decoder->
                                                       reg[0x08] & 0xfb) |
                                                      0x04);
                                        i2c_smbus_write_byte_data(client, 0x11,
                                                      (decoder->
                                                       reg[0x11] & 0xf3));
                                }
                        }
                }
                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;
                                i2c_smbus_write_byte_data(client, 0x0a,
                                              decoder->bright >> 8);
                        }
                        if (decoder->contrast != pic->contrast) {
                                /* We want 0 to 127 we get 0-65535 */
                                decoder->contrast = pic->contrast;
                                i2c_smbus_write_byte_data(client, 0x0b,
                                              decoder->contrast >> 9);
                        }
                        if (decoder->sat != pic->colour) {
                                /* We want 0 to 127 we get 0-65535 */
                                decoder->sat = pic->colour;
                                i2c_smbus_write_byte_data(client, 0x0c,
                                              decoder->sat >> 9);
                        }
                        if (decoder->hue != pic->hue) {
                                /* We want -128 to 127 we get 0-65535 */
                                decoder->hue = pic->hue;
                                i2c_smbus_write_byte_data(client, 0x0d,
                                              (decoder->hue - 32768) >> 8);
                        }
                }
                break;

        default:
                return -EINVAL;
        }

        return 0;
}

/* ----------------------------------------------------------------------- */

static struct i2c_driver i2c_driver_saa7111 = {
#if LINUX_VERSION_CODE > KERNEL_VERSION(2,5,54)
        .owner          = THIS_MODULE,
#endif
        .name           = "saa7111",             /* name */
        .id             = I2C_DRIVERID_SAA7111A, /* ID */
        .flags          = I2C_DF_NOTIFY,
        .attach_adapter = saa7111_probe,
        .detach_client  = saa7111_detach,
        .command        = saa7111_command
};

static struct i2c_client client_template = {
#if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0)
        .name   = "saa7111_client",
#else
        .dev    = {
                .name   = "saa7111_client",
        },
#endif
        .id     = -1,
        .driver = &i2c_driver_saa7111
};

static int saa7111_init(void)
{
        return i2c_add_driver(&i2c_driver_saa7111);
}

static void saa7111_exit(void)
{
        i2c_del_driver(&i2c_driver_saa7111);
}

module_init(saa7111_init);
module_exit(saa7111_exit);
MODULE_LICENSE("GPL");