1 files changed, 220 insertions, 0 deletions

diff --git a/drivers/media/video/tuner-3036.c b/drivers/media/video/tuner-3036.c
new file mode 100644
index 000000000000..6b20aa902a8f
--- /dev/null
+++ b/drivers/media/video/tuner-3036.c
@@ -0,0 +1,220 @@
+/*
+ * Driver for Philips SAB3036 "CITAC" tuner control chip.
+ *
+ * Author: Phil Blundell <philb@gnu.org>
+ *
+ * The SAB3036 is just about different enough from the chips that
+ * tuner.c copes with to make it not worth the effort to crowbar
+ * the support into that file.  So instead we have a separate driver. 
+ *
+ * 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.
+ */
+
+#include <linux/module.h>
+#include <linux/kernel.h>
+#include <linux/sched.h>
+#include <linux/string.h>
+#include <linux/timer.h>
+#include <linux/delay.h>
+#include <linux/errno.h>
+#include <linux/slab.h>
+#include <linux/init.h>
+
+#include <linux/i2c.h>
+#include <linux/videodev.h>
+
+#include <media/tuner.h>
+
+static int debug;       /* insmod parameter */
+static int this_adap;
+
+static struct i2c_client client_template;
+
+/* Addresses to scan */
+static unsigned short normal_i2c[] = {I2C_CLIENT_END};
+static unsigned short normal_i2c_range[] = {0x60, 0x61, I2C_CLIENT_END};
+static unsigned short probe[2]        = { I2C_CLIENT_END, I2C_CLIENT_END };
+static unsigned short probe_range[2]  = { I2C_CLIENT_END, I2C_CLIENT_END };
+static unsigned short ignore[2]       = { I2C_CLIENT_END, I2C_CLIENT_END };
+static unsigned short ignore_range[2] = { I2C_CLIENT_END, I2C_CLIENT_END };
+static unsigned short force[2]        = { I2C_CLIENT_END, I2C_CLIENT_END };
+
+static struct i2c_client_address_data addr_data = {
+        normal_i2c, normal_i2c_range, 
+        probe, probe_range, 
+        ignore, ignore_range, 
+        force
+};
+
+/* ---------------------------------------------------------------------- */
+
+static unsigned char
+tuner_getstatus (struct i2c_client *c)
+{
+        unsigned char byte;
+        if (i2c_master_recv(c, &byte, 1) != 1)
+                printk(KERN_ERR "tuner-3036: I/O error.\n");
+        return byte;
+}
+
+#define TUNER_FL        0x80
+
+static int 
+tuner_islocked (struct i2c_client *c)
+{
+        return (tuner_getstatus(c) & TUNER_FL);
+}
+
+/* ---------------------------------------------------------------------- */
+
+static void 
+set_tv_freq(struct i2c_client *c, int freq)
+{
+        u16 div = ((freq * 20) / 16);
+        unsigned long give_up = jiffies + HZ;
+        unsigned char buffer[2];
+
+        if (debug)
+                printk(KERN_DEBUG "tuner: setting frequency %dMHz, divisor %x\n", freq / 16, div);
+        
+        /* Select high tuning current */
+        buffer[0] = 0x29;
+        buffer[1] = 0x3e;
+
+        if (i2c_master_send(c, buffer, 2) != 2)
+                printk("tuner: i2c i/o error 1\n");
+        
+        buffer[0] = 0x80 | ((div>>8) & 0x7f);
+        buffer[1] = div & 0xff;
+
+        if (i2c_master_send(c, buffer, 2) != 2)
+                printk("tuner: i2c i/o error 2\n");
+        
+        while (!tuner_islocked(c) && time_before(jiffies, give_up))
+                schedule();
+               
+        if (!tuner_islocked(c))
+                printk(KERN_WARNING "tuner: failed to achieve PLL lock\n");
+        
+        /* Select low tuning current and engage AFC */
+        buffer[0] = 0x29;
+        buffer[1] = 0xb2;
+
+        if (i2c_master_send(c, buffer, 2) != 2)
+                printk("tuner: i2c i/o error 3\n");
+
+        if (debug)
+                printk(KERN_DEBUG "tuner: status %02x\n", tuner_getstatus(c));
+}
+
+/* ---------------------------------------------------------------------- */
+
+static int 
+tuner_attach(struct i2c_adapter *adap, int addr, int kind)
+{
+        static unsigned char buffer[] = { 0x29, 0x32, 0x2a, 0, 0x2b, 0 };
+
+        struct i2c_client *client;
+
+        if (this_adap > 0)
+                return -1;
+        this_adap++;
+        
+        client_template.adapter = adap;
+        client_template.addr = addr;
+
+        client = kmalloc(sizeof(struct i2c_client), GFP_KERNEL);
+        if (client == NULL)
+                return -ENOMEM;
+        memcpy(client, &client_template, sizeof(struct i2c_client));
+
+        printk("tuner: SAB3036 found, status %02x\n", tuner_getstatus(client));
+
+        i2c_attach_client(client);
+
+        if (i2c_master_send(client, buffer, 2) != 2)
+                printk("tuner: i2c i/o error 1\n");
+        if (i2c_master_send(client, buffer+2, 2) != 2)
+                printk("tuner: i2c i/o error 2\n");
+        if (i2c_master_send(client, buffer+4, 2) != 2)
+                printk("tuner: i2c i/o error 3\n");
+        return 0;
+}
+
+static int 
+tuner_detach(struct i2c_client *c)
+{
+        return 0;
+}
+
+static int 
+tuner_command(struct i2c_client *client, unsigned int cmd, void *arg)
+{
+        int *iarg = (int*)arg;
+
+        switch (cmd) 
+        {
+                case TUNER_SET_TVFREQ:
+                        set_tv_freq(client, *iarg);
+                        break;
+            
+                default:
+                        return -EINVAL;
+        }
+        return 0;
+}
+
+static int 
+tuner_probe(struct i2c_adapter *adap)
+{
+        this_adap = 0;
+        if (adap->id == (I2C_ALGO_BIT | I2C_HW_B_LP))
+                return i2c_probe(adap, &addr_data, tuner_attach);
+        return 0;
+}
+
+/* ----------------------------------------------------------------------- */
+
+static struct i2c_driver 
+i2c_driver_tuner = 
+{
+        .owner          =       THIS_MODULE,
+        .name           =       "sab3036",
+        .id             =       I2C_DRIVERID_SAB3036,
+        .flags          =       I2C_DF_NOTIFY,
+        .attach_adapter =       tuner_probe,
+        .detach_client  =       tuner_detach,
+        .command        =       tuner_command
+};
+
+static struct i2c_client client_template =
+{
+        .driver         = &i2c_driver_tuner,
+        .name           = "SAB3036",
+};
+
+static int __init
+tuner3036_init(void)
+{
+        i2c_add_driver(&i2c_driver_tuner);
+        return 0;
+}
+
+static void __exit
+tuner3036_exit(void)
+{
+        i2c_del_driver(&i2c_driver_tuner);
+}
+
+MODULE_DESCRIPTION("SAB3036 tuner driver");
+MODULE_AUTHOR("Philip Blundell <philb@gnu.org>");
+MODULE_LICENSE("GPL");
+
+module_param(debug, int, 0);
+MODULE_PARM_DESC(debug,"Enable debugging output");
+
+module_init(tuner3036_init);
+module_exit(tuner3036_exit);