SAFE public projects git trees. - safe/jmp/linux-2.6/blob - drivers/staging/tm6000/tm6000-i2c.c

   1 /*
   2    tm6000-i2c.c - driver for TM5600/TM6000 USB video capture devices
   3
   4    Copyright (C) 2006-2007 Mauro Carvalho Chehab <mchehab@infradead.org>
   5
   6    Copyright (C) 2007 Michel Ludwig <michel.ludwig@gmail.com>
   7         - Fix SMBus Read Byte command
   8
   9    This program is free software; you can redistribute it and/or modify
  10    it under the terms of the GNU General Public License as published by
  11    the Free Software Foundation version 2
  12
  13    This program is distributed in the hope that it will be useful,
  14    but WITHOUT ANY WARRANTY; without even the implied warranty of
  15    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16    GNU General Public License for more details.
  17
  18    You should have received a copy of the GNU General Public License
  19    along with this program; if not, write to the Free Software
  20    Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  21  */
  22
  23 #include <linux/module.h>
  24 #include <linux/kernel.h>
  25 #include <linux/usb.h>
  26 #include <linux/i2c.h>
  27
  28 #include "tm6000.h"
  29 #include "tm6000-regs.h"
  30 #include <media/v4l2-common.h>
  31 #include <media/tuner.h>
  32 #include "tuner-xc2028.h"
  33
  34
  35 /*FIXME: Hack to avoid needing to patch i2c-id.h */
  36 #define I2C_HW_B_TM6000 I2C_HW_B_EM28XX
  37 /* ----------------------------------------------------------- */
  38
  39 static unsigned int i2c_debug = 0;
  40 module_param(i2c_debug, int, 0644);
  41 MODULE_PARM_DESC(i2c_debug, "enable debug messages [i2c]");
  42
  43 #define i2c_dprintk(lvl,fmt, args...) if (i2c_debug>=lvl) do{ \
  44                         printk(KERN_DEBUG "%s at %s: " fmt, \
  45                         dev->name, __FUNCTION__ , ##args); } while (0)
  46
  47 static int tm6000_i2c_xfer(struct i2c_adapter *i2c_adap,
  48                            struct i2c_msg msgs[], int num)
  49 {
  50         struct tm6000_core *dev = i2c_adap->algo_data;
  51         int addr, rc, i, byte;
  52
  53         if (num <= 0)
  54                 return 0;
  55         for (i = 0; i < num; i++) {
  56                 addr = (msgs[i].addr << 1) & 0xff;
  57                 i2c_dprintk(2,"%s %s addr=0x%x len=%d:",
  58                          (msgs[i].flags & I2C_M_RD) ? "read" : "write",
  59                          i == num - 1 ? "stop" : "nonstop", addr, msgs[i].len);
  60                 if (msgs[i].flags & I2C_M_RD) {
  61                         /* read request without preceding register selection */
  62                         /*
  63                          * The TM6000 only supports a read transaction
  64                          * immediately after a 1 or 2 byte write to select
  65                          * a register.  We cannot fulfil this request.
  66                          */
  67                         i2c_dprintk(2, " read without preceding write not"
  68                                        " supported");
  69                         rc = -EOPNOTSUPP;
  70                         goto err;
  71                 } else if (i + 1 < num && msgs[i].len <= 2 &&
  72                            (msgs[i + 1].flags & I2C_M_RD) &&
  73                            msgs[i].addr == msgs[i + 1].addr) {
  74                         /* 1 or 2 byte write followed by a read */
  75                         if (i2c_debug >= 2)
  76                                 for (byte = 0; byte < msgs[i].len; byte++)
  77                                         printk(" %02x", msgs[i].buf[byte]);
  78                         i2c_dprintk(2, "; joined to read %s len=%d:",
  79                                     i == num - 2 ? "stop" : "nonstop",
  80                                     msgs[i + 1].len);
  81                         rc = tm6000_read_write_usb (dev,
  82                                 USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
  83                                 msgs[i].len == 1 ? REQ_16_SET_GET_I2C_WR1_RDN
  84                                                  : REQ_14_SET_GET_I2C_WR2_RDN,
  85                                 addr | msgs[i].buf[0] << 8,
  86                                 msgs[i].len == 1 ? 0 : msgs[i].buf[1],
  87                                 msgs[i + 1].buf, msgs[i + 1].len);
  88                         i++;
  89                         if (i2c_debug >= 2)
  90                                 for (byte = 0; byte < msgs[i].len; byte++)
  91                                         printk(" %02x", msgs[i].buf[byte]);
  92                 } else {
  93                         /* write bytes */
  94                         if (i2c_debug >= 2)
  95                                 for (byte = 0; byte < msgs[i].len; byte++)
  96                                         printk(" %02x", msgs[i].buf[byte]);
  97                         rc = tm6000_read_write_usb(dev,
  98                                 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
  99                                 REQ_16_SET_GET_I2C_WR1_RDN,
 100                                 addr | msgs[i].buf[0] << 8, 0,
 101                                 msgs[i].buf + 1, msgs[i].len - 1);
 102                 }
 103                 if (i2c_debug >= 2)
 104                         printk("\n");
 105                 if (rc < 0)
 106                         goto err;
 107         }
 108
 109         return num;
 110 err:
 111         i2c_dprintk(2," ERROR: %i\n", rc);
 112         return rc;
 113 }
 114
 115 static int tm6000_i2c_eeprom(struct tm6000_core *dev,
 116                              unsigned char *eedata, int len)
 117 {
 118         int i, rc;
 119         unsigned char *p = eedata;
 120         unsigned char bytes[17];
 121
 122         dev->i2c_client.addr = 0xa0 >> 1;
 123
 124         bytes[16] = '\0';
 125         for (i = 0; i < len; ) {
 126         *p = i;
 127         rc = tm6000_read_write_usb (dev,
 128                 USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
 129                 REQ_16_SET_GET_I2C_WR1_RDN, 0xa0 | i<<8, 0, p, 1);
 130                 if (rc < 1) {
 131                         if (p == eedata)
 132                                 goto noeeprom;
 133                         else {
 134                                 printk(KERN_WARNING
 135                                 "%s: i2c eeprom read error (err=%d)\n",
 136                                 dev->name, rc);
 137                         }
 138                         return -1;
 139                 }
 140                 p++;
 141                 if (0 == (i % 16))
 142                         printk(KERN_INFO "%s: i2c eeprom %02x:", dev->name, i);
 143                 printk(" %02x", eedata[i]);
 144                 if ((eedata[i] >= ' ') && (eedata[i] <= 'z')) {
 145                         bytes[i%16] = eedata[i];
 146                 } else {
 147                         bytes[i%16]='.';
 148                 }
 149
 150                 i++;
 151
 152                 if (0 == (i % 16)) {
 153                         bytes[16] = '\0';
 154                         printk("  %s\n", bytes);
 155                 }
 156         }
 157         if (0 != (i%16)) {
 158                 bytes[i%16] = '\0';
 159                 for (i %= 16; i < 16; i++)
 160                         printk("   ");
 161         }
 162         printk("  %s\n", bytes);
 163
 164         return 0;
 165
 166 noeeprom:
 167         printk(KERN_INFO "%s: Huh, no eeprom present (err=%d)?\n",
 168                        dev->name, rc);
 169         return rc;
 170 }
 171
 172 /* ----------------------------------------------------------- */
 173
 174 /*
 175  * functionality()
 176  */
 177 static u32 functionality(struct i2c_adapter *adap)
 178 {
 179         return I2C_FUNC_SMBUS_EMUL;
 180 }
 181
 182 #define mass_write(addr, reg, data...)                                  \
 183         { const static u8 _val[] = data;                                \
 184         rc=tm6000_read_write_usb(dev,USB_DIR_OUT | USB_TYPE_VENDOR,     \
 185         REQ_16_SET_GET_I2C_WR1_RDN,(reg<<8)+addr, 0x00, (u8 *) _val,    \
 186         ARRAY_SIZE(_val));                                              \
 187         if (rc<0) {                                                     \
 188                 printk(KERN_ERR "Error on line %d: %d\n",__LINE__,rc);  \
 189                 return rc;                                              \
 190         }                                                               \
 191         msleep (10);                                                    \
 192         }
 193
 194 static struct i2c_algorithm tm6000_algo = {
 195         .master_xfer   = tm6000_i2c_xfer,
 196         .functionality = functionality,
 197 };
 198
 199 static struct i2c_adapter tm6000_adap_template = {
 200         .owner = THIS_MODULE,
 201         .class = I2C_CLASS_TV_ANALOG,
 202         .name = "tm6000",
 203         .id = I2C_HW_B_TM6000,
 204         .algo = &tm6000_algo,
 205 };
 206
 207 static struct i2c_client tm6000_client_template = {
 208         .name = "tm6000 internal",
 209 };
 210
 211 /* ----------------------------------------------------------- */
 212
 213 /*
 214  * tm6000_i2c_register()
 215  * register i2c bus
 216  */
 217 int tm6000_i2c_register(struct tm6000_core *dev)
 218 {
 219         unsigned char eedata[256];
 220
 221         dev->i2c_adap = tm6000_adap_template;
 222         dev->i2c_adap.dev.parent = &dev->udev->dev;
 223         strcpy(dev->i2c_adap.name, dev->name);
 224         dev->i2c_adap.algo_data = dev;
 225         i2c_add_adapter(&dev->i2c_adap);
 226
 227         dev->i2c_client = tm6000_client_template;
 228         dev->i2c_client.adapter = &dev->i2c_adap;
 229
 230         i2c_set_adapdata(&dev->i2c_adap, &dev->v4l2_dev);
 231
 232         tm6000_i2c_eeprom(dev, eedata, sizeof(eedata));
 233
 234         return 0;
 235 }
 236
 237 /*
 238  * tm6000_i2c_unregister()
 239  * unregister i2c_bus
 240  */
 241 int tm6000_i2c_unregister(struct tm6000_core *dev)
 242 {
 243         i2c_del_adapter(&dev->i2c_adap);
 244         return 0;
 245 }