drivers/video/nvidia/nv_i2c.c

   1 /*
   2  * linux/drivers/video/nvidia/nvidia-i2c.c - nVidia i2c
   3  *
   4  * Copyright 2004 Antonino A. Daplas <adaplas @pol.net>
   5  *
   6  * Based on rivafb-i2c.c
   7  *
   8  * This file is subject to the terms and conditions of the GNU General Public
   9  * License.  See the file COPYING in the main directory of this archive
  10  * for more details.
  11  */
  12
  13 #include <linux/module.h>
  14 #include <linux/kernel.h>
  15 #include <linux/delay.h>
  16 #include <linux/pci.h>
  17 #include <linux/fb.h>
  18
  19 #include <asm/io.h>
  20
  21 #include "nv_type.h"
  22 #include "nv_local.h"
  23 #include "nv_proto.h"
  24
  25 #include "../edid.h"
  26
  27 static void nvidia_gpio_setscl(void *data, int state)
  28 {
  29         struct nvidia_i2c_chan *chan = data;
  30         struct nvidia_par *par = chan->par;
  31         u32 val;
  32
  33         val = NVReadCrtc(par, chan->ddc_base + 1) & 0xf0;
  34
  35         if (state)
  36                 val |= 0x20;
  37         else
  38                 val &= ~0x20;
  39
  40         NVWriteCrtc(par, chan->ddc_base + 1, val | 0x01);
  41 }
  42
  43 static void nvidia_gpio_setsda(void *data, int state)
  44 {
  45         struct nvidia_i2c_chan *chan = data;
  46         struct nvidia_par *par = chan->par;
  47         u32 val;
  48
  49         val = NVReadCrtc(par, chan->ddc_base + 1) & 0xf0;
  50
  51         if (state)
  52                 val |= 0x10;
  53         else
  54                 val &= ~0x10;
  55
  56         NVWriteCrtc(par, chan->ddc_base + 1, val | 0x01);
  57 }
  58
  59 static int nvidia_gpio_getscl(void *data)
  60 {
  61         struct nvidia_i2c_chan *chan = data;
  62         struct nvidia_par *par = chan->par;
  63         u32 val = 0;
  64
  65         if (NVReadCrtc(par, chan->ddc_base) & 0x04)
  66                 val = 1;
  67
  68         return val;
  69 }
  70
  71 static int nvidia_gpio_getsda(void *data)
  72 {
  73         struct nvidia_i2c_chan *chan = data;
  74         struct nvidia_par *par = chan->par;
  75         u32 val = 0;
  76
  77         if (NVReadCrtc(par, chan->ddc_base) & 0x08)
  78                 val = 1;
  79
  80         return val;
  81 }
  82
  83 static int nvidia_setup_i2c_bus(struct nvidia_i2c_chan *chan, const char *name,
  84                                 unsigned int i2c_class)
  85 {
  86         int rc;
  87
  88         strcpy(chan->adapter.name, name);
  89         chan->adapter.owner = THIS_MODULE;
  90         chan->adapter.id = I2C_HW_B_NVIDIA;
  91         chan->adapter.class = i2c_class;
  92         chan->adapter.algo_data = &chan->algo;
  93         chan->adapter.dev.parent = &chan->par->pci_dev->dev;
  94         chan->algo.setsda = nvidia_gpio_setsda;
  95         chan->algo.setscl = nvidia_gpio_setscl;
  96         chan->algo.getsda = nvidia_gpio_getsda;
  97         chan->algo.getscl = nvidia_gpio_getscl;
  98         chan->algo.udelay = 40;
  99         chan->algo.timeout = msecs_to_jiffies(2);
 100         chan->algo.data = chan;
 101
 102         i2c_set_adapdata(&chan->adapter, chan);
 103
 104         /* Raise SCL and SDA */
 105         nvidia_gpio_setsda(chan, 1);
 106         nvidia_gpio_setscl(chan, 1);
 107         udelay(20);
 108
 109         rc = i2c_bit_add_bus(&chan->adapter);
 110         if (rc == 0)
 111                 dev_dbg(&chan->par->pci_dev->dev,
 112                         "I2C bus %s registered.\n", name);
 113         else {
 114                 dev_warn(&chan->par->pci_dev->dev,
 115                          "Failed to register I2C bus %s.\n", name);
 116                 chan->par = NULL;
 117         }
 118
 119         return rc;
 120 }
 121
 122 void nvidia_create_i2c_busses(struct nvidia_par *par)
 123 {
 124         par->chan[0].par = par;
 125         par->chan[1].par = par;
 126         par->chan[2].par = par;
 127
 128         par->chan[0].ddc_base = (par->reverse_i2c) ? 0x36 : 0x3e;
 129         nvidia_setup_i2c_bus(&par->chan[0], "nvidia #0",
 130                              (par->reverse_i2c) ? I2C_CLASS_HWMON : 0);
 131
 132         par->chan[1].ddc_base = (par->reverse_i2c) ? 0x3e : 0x36;
 133         nvidia_setup_i2c_bus(&par->chan[1], "nvidia #1",
 134                              (par->reverse_i2c) ? 0 : I2C_CLASS_HWMON);
 135
 136         par->chan[2].ddc_base = 0x50;
 137         nvidia_setup_i2c_bus(&par->chan[2], "nvidia #2", 0);
 138 }
 139
 140 void nvidia_delete_i2c_busses(struct nvidia_par *par)
 141 {
 142         int i;
 143
 144         for (i = 0; i < 3; i++) {
 145                 if (!par->chan[i].par)
 146                         continue;
 147                 i2c_del_adapter(&par->chan[i].adapter);
 148                 par->chan[i].par = NULL;
 149         }
 150 }
 151
 152 int nvidia_probe_i2c_connector(struct fb_info *info, int conn, u8 **out_edid)
 153 {
 154         struct nvidia_par *par = info->par;
 155         u8 *edid = NULL;
 156
 157         if (par->chan[conn - 1].par)
 158                 edid = fb_ddc_read(&par->chan[conn - 1].adapter);
 159
 160         if (!edid && conn == 1) {
 161                 /* try to get from firmware */
 162                 const u8 *e = fb_firmware_edid(info->device);
 163
 164                 if (e != NULL)
 165                         edid = kmemdup(e, EDID_LENGTH, GFP_KERNEL);
 166         }
 167
 168         *out_edid = edid;
 169
 170         return (edid) ? 0 : 1;
 171 }