drm/nvd0/i2c: initial implementation

Signed-off-by: Ben Skeggs <bskeggs@redhat.com>

1 files changed, 35 insertions, 16 deletions

diff --git a/drivers/gpu/drm/nouveau/nouveau_i2c.c b/drivers/gpu/drm/nouveau/nouveau_i2c.c
index cb389d014326..739c0ac3a9b7 100644
--- a/drivers/gpu/drm/nouveau/nouveau_i2c.c
+++ b/drivers/gpu/drm/nouveau/nouveau_i2c.c
@@ -107,6 +107,13 @@ nv4e_i2c_getsda(void *data)
         return !!((nv_rd32(dev, i2c->rd) >> 16) & 8);
 }
 
+static const uint32_t nv50_i2c_port[] = {
+        0x00e138, 0x00e150, 0x00e168, 0x00e180,
+        0x00e254, 0x00e274, 0x00e764, 0x00e780,
+        0x00e79c, 0x00e7b8
+};
+#define NV50_I2C_PORTS ARRAY_SIZE(nv50_i2c_port)
+
 static int
 nv50_i2c_getscl(void *data)
 {
@@ -130,28 +137,32 @@ static void
 nv50_i2c_setscl(void *data, int state)
 {
         struct nouveau_i2c_chan *i2c = data;
-        struct drm_device *dev = i2c->dev;
 
-        nv_wr32(dev, i2c->wr, 4 | (i2c->data ? 2 : 0) | (state ? 1 : 0));
+        nv_wr32(i2c->dev, i2c->wr, 4 | (i2c->data ? 2 : 0) | (state ? 1 : 0));
 }
 
 static void
 nv50_i2c_setsda(void *data, int state)
 {
         struct nouveau_i2c_chan *i2c = data;
-        struct drm_device *dev = i2c->dev;
 
-        nv_wr32(dev, i2c->wr,
-                        (nv_rd32(dev, i2c->rd) & 1) | 4 | (state ? 2 : 0));
+        nv_mask(i2c->dev, i2c->wr, 0x00000006, 4 | (state ? 2 : 0));
         i2c->data = state;
 }
 
-static const uint32_t nv50_i2c_port[] = {
-        0x00e138, 0x00e150, 0x00e168, 0x00e180,
-        0x00e254, 0x00e274, 0x00e764, 0x00e780,
-        0x00e79c, 0x00e7b8
-};
-#define NV50_I2C_PORTS ARRAY_SIZE(nv50_i2c_port)
+static int
+nvd0_i2c_getscl(void *data)
+{
+        struct nouveau_i2c_chan *i2c = data;
+        return !!(nv_rd32(i2c->dev, i2c->rd) & 0x10);
+}
+
+static int
+nvd0_i2c_getsda(void *data)
+{
+        struct nouveau_i2c_chan *i2c = data;
+        return !!(nv_rd32(i2c->dev, i2c->rd) & 0x20);
+}
 
 int
 nouveau_i2c_init(struct drm_device *dev, struct dcb_i2c_entry *entry, int index)
@@ -163,7 +174,8 @@ nouveau_i2c_init(struct drm_device *dev, struct dcb_i2c_entry *entry, int index)
         if (entry->chan)
                 return -EEXIST;
 
-        if (dev_priv->card_type >= NV_50 && entry->read >= NV50_I2C_PORTS) {
+        if (dev_priv->card_type >= NV_50 &&
+            dev_priv->card_type <= NV_C0 && entry->read >= NV50_I2C_PORTS) {
                 NV_ERROR(dev, "unknown i2c port %d\n", entry->read);
                 return -EINVAL;
         }
@@ -192,10 +204,17 @@ nouveau_i2c_init(struct drm_device *dev, struct dcb_i2c_entry *entry, int index)
         case 5:
                 i2c->bit.setsda = nv50_i2c_setsda;
                 i2c->bit.setscl = nv50_i2c_setscl;
-                i2c->bit.getsda = nv50_i2c_getsda;
-                i2c->bit.getscl = nv50_i2c_getscl;
-                i2c->rd = nv50_i2c_port[entry->read];
-                i2c->wr = i2c->rd;
+                if (dev_priv->card_type < NV_D0) {
+                        i2c->bit.getsda = nv50_i2c_getsda;
+                        i2c->bit.getscl = nv50_i2c_getscl;
+                        i2c->rd = nv50_i2c_port[entry->read];
+                        i2c->wr = i2c->rd;
+                } else {
+                        i2c->bit.getsda = nvd0_i2c_getsda;
+                        i2c->bit.getscl = nvd0_i2c_getscl;
+                        i2c->rd = 0x00d014 + (entry->read * 0x20);
+                        i2c->wr = i2c->rd;
+                }
                 break;
         case 6:
                 i2c->rd = entry->read;