drivers/gpu/drm/nouveau/nouveau_i2c.c - kernel/msm-4.9 - Gitiles

 /*
  * Copyright 2009 Red Hat Inc.
  *
  * Permission is hereby granted, free of charge, to any person obtaining a
  * copy of this software and associated documentation files (the "Software"),
  * to deal in the Software without restriction, including without limitation
  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
  * and/or sell copies of the Software, and to permit persons to whom the
  * Software is furnished to do so, subject to the following conditions:
  *
  * The above copyright notice and this permission notice shall be included in
  * all copies or substantial portions of the Software.
  *
  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
  * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
  * OTHER DEALINGS IN THE SOFTWARE.
  *
  * Authors: Ben Skeggs
  */

 #include "drmP.h"
 #include "nouveau_drv.h"
 #include "nouveau_i2c.h"
 #include "nouveau_hw.h"

 static void
 nv04_i2c_setscl(void *data, int state)
 {
 	struct nouveau_i2c_chan *i2c = data;
 	struct drm_device *dev = i2c->dev;
 	uint8_t val;

 	val = (NVReadVgaCrtc(dev, 0, i2c->wr) & 0xd0) | (state ? 0x20 : 0);
 	NVWriteVgaCrtc(dev, 0, i2c->wr, val | 0x01);
 }

 static void
 nv04_i2c_setsda(void *data, int state)
 {
 	struct nouveau_i2c_chan *i2c = data;
 	struct drm_device *dev = i2c->dev;
 	uint8_t val;

 	val = (NVReadVgaCrtc(dev, 0, i2c->wr) & 0xe0) | (state ? 0x10 : 0);
 	NVWriteVgaCrtc(dev, 0, i2c->wr, val | 0x01);
 }

 static int
 nv04_i2c_getscl(void *data)
 {
 	struct nouveau_i2c_chan *i2c = data;
 	struct drm_device *dev = i2c->dev;

 	return !!(NVReadVgaCrtc(dev, 0, i2c->rd) & 4);
 }

 static int
 nv04_i2c_getsda(void *data)
 {
 	struct nouveau_i2c_chan *i2c = data;
 	struct drm_device *dev = i2c->dev;

 	return !!(NVReadVgaCrtc(dev, 0, i2c->rd) & 8);
 }

 static void
 nv4e_i2c_setscl(void *data, int state)
 {
 	struct nouveau_i2c_chan *i2c = data;
 	struct drm_device *dev = i2c->dev;
 	uint8_t val;

 	val = (nv_rd32(dev, i2c->wr) & 0xd0) | (state ? 0x20 : 0);
 	nv_wr32(dev, i2c->wr, val | 0x01);
 }

 static void
 nv4e_i2c_setsda(void *data, int state)
 {
 	struct nouveau_i2c_chan *i2c = data;
 	struct drm_device *dev = i2c->dev;
 	uint8_t val;

 	val = (nv_rd32(dev, i2c->wr) & 0xe0) | (state ? 0x10 : 0);
 	nv_wr32(dev, i2c->wr, val | 0x01);
 }

 static int
 nv4e_i2c_getscl(void *data)
 {
 	struct nouveau_i2c_chan *i2c = data;
 	struct drm_device *dev = i2c->dev;

 	return !!((nv_rd32(dev, i2c->rd) >> 16) & 4);
 }

 static int
 nv4e_i2c_getsda(void *data)
 {
 	struct nouveau_i2c_chan *i2c = data;
 	struct drm_device *dev = i2c->dev;

 	return !!((nv_rd32(dev, i2c->rd) >> 16) & 8);
 }

 static int
 nv50_i2c_getscl(void *data)
 {
 	struct nouveau_i2c_chan *i2c = data;
 	struct drm_device *dev = i2c->dev;

 	return !!(nv_rd32(dev, i2c->rd) & 1);
 }


 static int
 nv50_i2c_getsda(void *data)
 {
 	struct nouveau_i2c_chan *i2c = data;
 	struct drm_device *dev = i2c->dev;

 	return !!(nv_rd32(dev, i2c->rd) & 2);
 }

 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));
 }

 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));
 	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)

 int
 nouveau_i2c_init(struct drm_device *dev, struct dcb_i2c_entry *entry, int index)
 {
 	struct drm_nouveau_private *dev_priv = dev->dev_private;
 	struct nouveau_i2c_chan *i2c;
 	int ret;

 	if (entry->chan)
 		return -EEXIST;

 	if (dev_priv->card_type == NV_50 && entry->read >= NV50_I2C_PORTS) {
 		NV_ERROR(dev, "unknown i2c port %d\n", entry->read);
 		return -EINVAL;
 	}

 	i2c = kzalloc(sizeof(*i2c), GFP_KERNEL);
 	if (i2c == NULL)
 		return -ENOMEM;

 	switch (entry->port_type) {
 	case 0:
 		i2c->algo.bit.setsda = nv04_i2c_setsda;
 		i2c->algo.bit.setscl = nv04_i2c_setscl;
 		i2c->algo.bit.getsda = nv04_i2c_getsda;
 		i2c->algo.bit.getscl = nv04_i2c_getscl;
 		i2c->rd = entry->read;
 		i2c->wr = entry->write;
 		break;
 	case 4:
 		i2c->algo.bit.setsda = nv4e_i2c_setsda;
 		i2c->algo.bit.setscl = nv4e_i2c_setscl;
 		i2c->algo.bit.getsda = nv4e_i2c_getsda;
 		i2c->algo.bit.getscl = nv4e_i2c_getscl;
 		i2c->rd = 0x600800 + entry->read;
 		i2c->wr = 0x600800 + entry->write;
 		break;
 	case 5:
 		i2c->algo.bit.setsda = nv50_i2c_setsda;
 		i2c->algo.bit.setscl = nv50_i2c_setscl;
 		i2c->algo.bit.getsda = nv50_i2c_getsda;
 		i2c->algo.bit.getscl = nv50_i2c_getscl;
 		i2c->rd = nv50_i2c_port[entry->read];
 		i2c->wr = i2c->rd;
 		break;
 	case 6:
 		i2c->rd = entry->read;
 		i2c->wr = entry->write;
 		break;
 	default:
 		NV_ERROR(dev, "DCB I2C port type %d unknown\n",
 			 entry->port_type);
 		kfree(i2c);
 		return -EINVAL;
 	}

 	snprintf(i2c->adapter.name, sizeof(i2c->adapter.name),
 		 "nouveau-%s-%d", pci_name(dev->pdev), index);
 	i2c->adapter.owner = THIS_MODULE;
 	i2c->adapter.dev.parent = &dev->pdev->dev;
 	i2c->dev = dev;
 	i2c_set_adapdata(&i2c->adapter, i2c);

 	if (entry->port_type < 6) {
 		i2c->adapter.algo_data = &i2c->algo.bit;
 		i2c->algo.bit.udelay = 40;
 		i2c->algo.bit.timeout = usecs_to_jiffies(5000);
 		i2c->algo.bit.data = i2c;
 		ret = i2c_bit_add_bus(&i2c->adapter);
 	} else {
 		i2c->adapter.algo_data = &i2c->algo.dp;
 		i2c->algo.dp.running = false;
 		i2c->algo.dp.address = 0;
 		i2c->algo.dp.aux_ch = nouveau_dp_i2c_aux_ch;
 		ret = i2c_dp_aux_add_bus(&i2c->adapter);
 	}

 	if (ret) {
 		NV_ERROR(dev, "Failed to register i2c %d\n", index);
 		kfree(i2c);
 		return ret;
 	}

 	entry->chan = i2c;
 	return 0;
 }

 void
 nouveau_i2c_fini(struct drm_device *dev, struct dcb_i2c_entry *entry)
 {
 	if (!entry->chan)
 		return;

 	i2c_del_adapter(&entry->chan->adapter);
 	kfree(entry->chan);
 	entry->chan = NULL;
 }

 struct nouveau_i2c_chan *
 nouveau_i2c_find(struct drm_device *dev, int index)
 {
 	struct drm_nouveau_private *dev_priv = dev->dev_private;
 	struct dcb_i2c_entry *i2c = &dev_priv->vbios.dcb.i2c[index];

 	if (index >= DCB_MAX_NUM_I2C_ENTRIES)
 		return NULL;

 	if (dev_priv->chipset >= NV_50 && (i2c->entry & 0x00000100)) {
 		uint32_t reg = 0xe500, val;

 		if (i2c->port_type == 6) {
 			reg += i2c->read * 0x50;
 			val  = 0x2002;
 		} else {
 			reg += ((i2c->entry & 0x1e00) >> 9) * 0x50;
 			val  = 0xe001;
 		}

 		nv_wr32(dev, reg, (nv_rd32(dev, reg) & ~0xf003) | val);
 	}

 	if (!i2c->chan && nouveau_i2c_init(dev, i2c, index))
 		return NULL;
 	return i2c->chan;
 }
	/*
	* Copyright 2009 Red Hat Inc.
	*
	* Permission is hereby granted, free of charge, to any person obtaining a
	* copy of this software and associated documentation files (the "Software"),
	* to deal in the Software without restriction, including without limitation
	* the rights to use, copy, modify, merge, publish, distribute, sublicense,
	* and/or sell copies of the Software, and to permit persons to whom the
	* Software is furnished to do so, subject to the following conditions:
	*
	* The above copyright notice and this permission notice shall be included in
	* all copies or substantial portions of the Software.
	*
	* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
	* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
	* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
	* THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
	* OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
	* ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
	* OTHER DEALINGS IN THE SOFTWARE.
	*
	* Authors: Ben Skeggs
	*/

	#include "drmP.h"
	#include "nouveau_drv.h"
	#include "nouveau_i2c.h"
	#include "nouveau_hw.h"

	static void
	nv04_i2c_setscl(void *data, int state)
	{
	struct nouveau_i2c_chan *i2c = data;
	struct drm_device *dev = i2c->dev;
	uint8_t val;

	val = (NVReadVgaCrtc(dev, 0, i2c->wr) & 0xd0) \| (state ? 0x20 : 0);
	NVWriteVgaCrtc(dev, 0, i2c->wr, val \| 0x01);
	}

	static void
	nv04_i2c_setsda(void *data, int state)
	{
	struct nouveau_i2c_chan *i2c = data;
	struct drm_device *dev = i2c->dev;
	uint8_t val;

	val = (NVReadVgaCrtc(dev, 0, i2c->wr) & 0xe0) \| (state ? 0x10 : 0);
	NVWriteVgaCrtc(dev, 0, i2c->wr, val \| 0x01);
	}

	static int
	nv04_i2c_getscl(void *data)
	{
	struct nouveau_i2c_chan *i2c = data;
	struct drm_device *dev = i2c->dev;

	return !!(NVReadVgaCrtc(dev, 0, i2c->rd) & 4);
	}

	static int
	nv04_i2c_getsda(void *data)
	{
	struct nouveau_i2c_chan *i2c = data;
	struct drm_device *dev = i2c->dev;

	return !!(NVReadVgaCrtc(dev, 0, i2c->rd) & 8);
	}

	static void
	nv4e_i2c_setscl(void *data, int state)
	{
	struct nouveau_i2c_chan *i2c = data;
	struct drm_device *dev = i2c->dev;
	uint8_t val;

	val = (nv_rd32(dev, i2c->wr) & 0xd0) \| (state ? 0x20 : 0);
	nv_wr32(dev, i2c->wr, val \| 0x01);
	}

	static void
	nv4e_i2c_setsda(void *data, int state)
	{
	struct nouveau_i2c_chan *i2c = data;
	struct drm_device *dev = i2c->dev;
	uint8_t val;

	val = (nv_rd32(dev, i2c->wr) & 0xe0) \| (state ? 0x10 : 0);
	nv_wr32(dev, i2c->wr, val \| 0x01);
	}

	static int
	nv4e_i2c_getscl(void *data)
	{
	struct nouveau_i2c_chan *i2c = data;
	struct drm_device *dev = i2c->dev;

	return !!((nv_rd32(dev, i2c->rd) >> 16) & 4);
	}

	static int
	nv4e_i2c_getsda(void *data)
	{
	struct nouveau_i2c_chan *i2c = data;
	struct drm_device *dev = i2c->dev;

	return !!((nv_rd32(dev, i2c->rd) >> 16) & 8);
	}

	static int
	nv50_i2c_getscl(void *data)
	{
	struct nouveau_i2c_chan *i2c = data;
	struct drm_device *dev = i2c->dev;

	return !!(nv_rd32(dev, i2c->rd) & 1);
	}


	static int
	nv50_i2c_getsda(void *data)
	{
	struct nouveau_i2c_chan *i2c = data;
	struct drm_device *dev = i2c->dev;

	return !!(nv_rd32(dev, i2c->rd) & 2);
	}

	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));
	}

	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));
	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)

	int
	nouveau_i2c_init(struct drm_device dev, struct dcb_i2c_entry entry, int index)
	{
	struct drm_nouveau_private *dev_priv = dev->dev_private;
	struct nouveau_i2c_chan *i2c;
	int ret;

	if (entry->chan)
	return -EEXIST;

	if (dev_priv->card_type == NV_50 && entry->read >= NV50_I2C_PORTS) {
	NV_ERROR(dev, "unknown i2c port %d\n", entry->read);
	return -EINVAL;
	}

	i2c = kzalloc(sizeof(*i2c), GFP_KERNEL);
	if (i2c == NULL)
	return -ENOMEM;

	switch (entry->port_type) {
	case 0:
	i2c->algo.bit.setsda = nv04_i2c_setsda;
	i2c->algo.bit.setscl = nv04_i2c_setscl;
	i2c->algo.bit.getsda = nv04_i2c_getsda;
	i2c->algo.bit.getscl = nv04_i2c_getscl;
	i2c->rd = entry->read;
	i2c->wr = entry->write;
	break;
	case 4:
	i2c->algo.bit.setsda = nv4e_i2c_setsda;
	i2c->algo.bit.setscl = nv4e_i2c_setscl;
	i2c->algo.bit.getsda = nv4e_i2c_getsda;
	i2c->algo.bit.getscl = nv4e_i2c_getscl;
	i2c->rd = 0x600800 + entry->read;
	i2c->wr = 0x600800 + entry->write;
	break;
	case 5:
	i2c->algo.bit.setsda = nv50_i2c_setsda;
	i2c->algo.bit.setscl = nv50_i2c_setscl;
	i2c->algo.bit.getsda = nv50_i2c_getsda;
	i2c->algo.bit.getscl = nv50_i2c_getscl;
	i2c->rd = nv50_i2c_port[entry->read];
	i2c->wr = i2c->rd;
	break;
	case 6:
	i2c->rd = entry->read;
	i2c->wr = entry->write;
	break;
	default:
	NV_ERROR(dev, "DCB I2C port type %d unknown\n",
	entry->port_type);
	kfree(i2c);
	return -EINVAL;
	}

	snprintf(i2c->adapter.name, sizeof(i2c->adapter.name),
	"nouveau-%s-%d", pci_name(dev->pdev), index);
	i2c->adapter.owner = THIS_MODULE;
	i2c->adapter.dev.parent = &dev->pdev->dev;
	i2c->dev = dev;
	i2c_set_adapdata(&i2c->adapter, i2c);

	if (entry->port_type < 6) {
	i2c->adapter.algo_data = &i2c->algo.bit;
	i2c->algo.bit.udelay = 40;
	i2c->algo.bit.timeout = usecs_to_jiffies(5000);
	i2c->algo.bit.data = i2c;
	ret = i2c_bit_add_bus(&i2c->adapter);
	} else {
	i2c->adapter.algo_data = &i2c->algo.dp;
	i2c->algo.dp.running = false;
	i2c->algo.dp.address = 0;
	i2c->algo.dp.aux_ch = nouveau_dp_i2c_aux_ch;
	ret = i2c_dp_aux_add_bus(&i2c->adapter);
	}

	if (ret) {
	NV_ERROR(dev, "Failed to register i2c %d\n", index);
	kfree(i2c);
	return ret;
	}

	entry->chan = i2c;
	return 0;
	}

	void
	nouveau_i2c_fini(struct drm_device dev, struct dcb_i2c_entry entry)
	{
	if (!entry->chan)
	return;

	i2c_del_adapter(&entry->chan->adapter);
	kfree(entry->chan);
	entry->chan = NULL;
	}

	struct nouveau_i2c_chan *
	nouveau_i2c_find(struct drm_device *dev, int index)
	{
	struct drm_nouveau_private *dev_priv = dev->dev_private;
	struct dcb_i2c_entry *i2c = &dev_priv->vbios.dcb.i2c[index];

	if (index >= DCB_MAX_NUM_I2C_ENTRIES)
	return NULL;

	if (dev_priv->chipset >= NV_50 && (i2c->entry & 0x00000100)) {
	uint32_t reg = 0xe500, val;

	if (i2c->port_type == 6) {
	reg += i2c->read * 0x50;
	val = 0x2002;
	} else {
	reg += ((i2c->entry & 0x1e00) >> 9) * 0x50;
	val = 0xe001;
	}

	nv_wr32(dev, reg, (nv_rd32(dev, reg) & ~0xf003) \| val);
	}

	if (!i2c->chan && nouveau_i2c_init(dev, i2c, index))
	return NULL;
	return i2c->chan;
	}