[net-next-2.6.git] / drivers / gpu / drm / nouveau / nouveau_i2c.c

/*
 * 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;
}

bool
nouveau_probe_i2c_addr(struct nouveau_i2c_chan *i2c, int addr)
{
	uint8_t buf[] = { 0 };
	struct i2c_msg msgs[] = {
		{
			.addr = addr,
			.flags = 0,
			.len = 1,
			.buf = buf,
		},
		{
			.addr = addr,
			.flags = I2C_M_RD,
			.len = 1,
			.buf = buf,
		}
	};

	return i2c_transfer(&i2c->adapter, msgs, 2) == 2;
}

int
nouveau_i2c_identify(struct drm_device *dev, const char *what,
		     struct i2c_board_info *info, int index)
{
	struct nouveau_i2c_chan *i2c = nouveau_i2c_find(dev, index);
	int i;

	NV_DEBUG(dev, "Probing %ss on I2C bus: %d\n", what, index);

	for (i = 0; info[i].addr; i++) {
		if (nouveau_probe_i2c_addr(i2c, info[i].addr)) {
			NV_INFO(dev, "Detected %s: %s\n", what, info[i].type);
			return i;
		}
	}

	NV_DEBUG(dev, "No devices found.\n");

	return -ENODEV;
}
Commit	Line	Data
6ee73861 BS	1	/*
	2	* Copyright 2009 Red Hat Inc.
	3	*
	4	* Permission is hereby granted, free of charge, to any person obtaining a
	5	* copy of this software and associated documentation files (the "Software"),
	6	* to deal in the Software without restriction, including without limitation
	7	* the rights to use, copy, modify, merge, publish, distribute, sublicense,
	8	* and/or sell copies of the Software, and to permit persons to whom the
	9	* Software is furnished to do so, subject to the following conditions:
	10	*
	11	* The above copyright notice and this permission notice shall be included in
	12	* all copies or substantial portions of the Software.
	13	*
	14	* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
	15	* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
	16	* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
	17	* THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
	18	* OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
	19	* ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
	20	* OTHER DEALINGS IN THE SOFTWARE.
	21	*
	22	* Authors: Ben Skeggs
	23	*/
	24
	25	#include "drmP.h"
	26	#include "nouveau_drv.h"
	27	#include "nouveau_i2c.h"
	28	#include "nouveau_hw.h"
	29
	30	static void
	31	nv04_i2c_setscl(void *data, int state)
	32	{
	33	struct nouveau_i2c_chan *i2c = data;
	34	struct drm_device *dev = i2c->dev;
	35	uint8_t val;
	36
	37	val = (NVReadVgaCrtc(dev, 0, i2c->wr) & 0xd0) \| (state ? 0x20 : 0);
	38	NVWriteVgaCrtc(dev, 0, i2c->wr, val \| 0x01);
	39	}
	40
	41	static void
	42	nv04_i2c_setsda(void *data, int state)
	43	{
	44	struct nouveau_i2c_chan *i2c = data;
	45	struct drm_device *dev = i2c->dev;
	46	uint8_t val;
	47
	48	val = (NVReadVgaCrtc(dev, 0, i2c->wr) & 0xe0) \| (state ? 0x10 : 0);
	49	NVWriteVgaCrtc(dev, 0, i2c->wr, val \| 0x01);
	50	}
	51
	52	static int
	53	nv04_i2c_getscl(void *data)
	54	{
	55	struct nouveau_i2c_chan *i2c = data;
	56	struct drm_device *dev = i2c->dev;
	57
	58	return !!(NVReadVgaCrtc(dev, 0, i2c->rd) & 4);
	59	}
	60
	61	static int
	62	nv04_i2c_getsda(void *data)
	63	{
	64	struct nouveau_i2c_chan *i2c = data;
65	struct drm_device *dev = i2c->dev;
66
67	return !!(NVReadVgaCrtc(dev, 0, i2c->rd) & 8);
68	}
69
70	static void
71	nv4e_i2c_setscl(void *data, int state)
72	{
73	struct nouveau_i2c_chan *i2c = data;
74	struct drm_device *dev = i2c->dev;
75	uint8_t val;
76
77	val = (nv_rd32(dev, i2c->wr) & 0xd0) \| (state ? 0x20 : 0);
78	nv_wr32(dev, i2c->wr, val \| 0x01);
79	}
80
81	static void
82	nv4e_i2c_setsda(void *data, int state)
83	{
84	struct nouveau_i2c_chan *i2c = data;
85	struct drm_device *dev = i2c->dev;
86	uint8_t val;
87
88	val = (nv_rd32(dev, i2c->wr) & 0xe0) \| (state ? 0x10 : 0);
89	nv_wr32(dev, i2c->wr, val \| 0x01);
90	}
91
92	static int
93	nv4e_i2c_getscl(void *data)
94	{
95	struct nouveau_i2c_chan *i2c = data;
96	struct drm_device *dev = i2c->dev;
97
98	return !!((nv_rd32(dev, i2c->rd) >> 16) & 4);
99	}
100
101	static int
102	nv4e_i2c_getsda(void *data)
103	{
104	struct nouveau_i2c_chan *i2c = data;
105	struct drm_device *dev = i2c->dev;
106
107	return !!((nv_rd32(dev, i2c->rd) >> 16) & 8);
108	}
109
110	static int
111	nv50_i2c_getscl(void *data)
112	{
113	struct nouveau_i2c_chan *i2c = data;
114	struct drm_device *dev = i2c->dev;
115
116	return !!(nv_rd32(dev, i2c->rd) & 1);
117	}
118
119
120	static int
121	nv50_i2c_getsda(void *data)
122	{
123	struct nouveau_i2c_chan *i2c = data;
124	struct drm_device *dev = i2c->dev;
125
126	return !!(nv_rd32(dev, i2c->rd) & 2);
127	}
128
129	static void
130	nv50_i2c_setscl(void *data, int state)
131	{
132	struct nouveau_i2c_chan *i2c = data;
133	struct drm_device *dev = i2c->dev;
134
135	nv_wr32(dev, i2c->wr, 4 \| (i2c->data ? 2 : 0) \| (state ? 1 : 0));
136	}
137
138	static void
139	nv50_i2c_setsda(void *data, int state)
140	{
141	struct nouveau_i2c_chan *i2c = data;
142	struct drm_device *dev = i2c->dev;
143
144	nv_wr32(dev, i2c->wr,
145	(nv_rd32(dev, i2c->rd) & 1) \| 4 \| (state ? 2 : 0));
146	i2c->data = state;
147	}
148
149	static const uint32_t nv50_i2c_port[] = {
150	0x00e138, 0x00e150, 0x00e168, 0x00e180,
151	0x00e254, 0x00e274, 0x00e764, 0x00e780,
152	0x00e79c, 0x00e7b8
153	};
154	#define NV50_I2C_PORTS ARRAY_SIZE(nv50_i2c_port)
155
156	int
157	nouveau_i2c_init(struct drm_device dev, struct dcb_i2c_entry entry, int index)
158	{
159	struct drm_nouveau_private *dev_priv = dev->dev_private;
160	struct nouveau_i2c_chan *i2c;
161	int ret;
162
163	if (entry->chan)
164	return -EEXIST;
165
166	if (dev_priv->card_type == NV_50 && entry->read >= NV50_I2C_PORTS) {
167	NV_ERROR(dev, "unknown i2c port %d\n", entry->read);
168	return -EINVAL;
169	}
170
171	i2c = kzalloc(sizeof(*i2c), GFP_KERNEL);
172	if (i2c == NULL)
173	return -ENOMEM;
174
175	switch (entry->port_type) {
176	case 0:
177	i2c->algo.bit.setsda = nv04_i2c_setsda;
178	i2c->algo.bit.setscl = nv04_i2c_setscl;
179	i2c->algo.bit.getsda = nv04_i2c_getsda;
180	i2c->algo.bit.getscl = nv04_i2c_getscl;
181	i2c->rd = entry->read;
182	i2c->wr = entry->write;
183	break;
184	case 4:
185	i2c->algo.bit.setsda = nv4e_i2c_setsda;
186	i2c->algo.bit.setscl = nv4e_i2c_setscl;
187	i2c->algo.bit.getsda = nv4e_i2c_getsda;
188	i2c->algo.bit.getscl = nv4e_i2c_getscl;
189	i2c->rd = 0x600800 + entry->read;
190	i2c->wr = 0x600800 + entry->write;
191	break;
192	case 5:
193	i2c->algo.bit.setsda = nv50_i2c_setsda;
194	i2c->algo.bit.setscl = nv50_i2c_setscl;
195	i2c->algo.bit.getsda = nv50_i2c_getsda;
196	i2c->algo.bit.getscl = nv50_i2c_getscl;
197	i2c->rd = nv50_i2c_port[entry->read];
198	i2c->wr = i2c->rd;
199	break;
200	case 6:
201	i2c->rd = entry->read;
202	i2c->wr = entry->write;
203	break;
204	default:
205	NV_ERROR(dev, "DCB I2C port type %d unknown\n",
206	entry->port_type);
207	kfree(i2c);
208	return -EINVAL;
209	}
210
211	snprintf(i2c->adapter.name, sizeof(i2c->adapter.name),
212	"nouveau-%s-%d", pci_name(dev->pdev), index);
213	i2c->adapter.owner = THIS_MODULE;
214	i2c->adapter.dev.parent = &dev->pdev->dev;
215	i2c->dev = dev;
216	i2c_set_adapdata(&i2c->adapter, i2c);
217
218	if (entry->port_type < 6) {
219	i2c->adapter.algo_data = &i2c->algo.bit;
220	i2c->algo.bit.udelay = 40;
221	i2c->algo.bit.timeout = usecs_to_jiffies(5000);
222	i2c->algo.bit.data = i2c;
223	ret = i2c_bit_add_bus(&i2c->adapter);
224	} else {
225	i2c->adapter.algo_data = &i2c->algo.dp;
226	i2c->algo.dp.running = false;
227	i2c->algo.dp.address = 0;
228	i2c->algo.dp.aux_ch = nouveau_dp_i2c_aux_ch;
229	ret = i2c_dp_aux_add_bus(&i2c->adapter);
230	}
231
232	if (ret) {
233	NV_ERROR(dev, "Failed to register i2c %d\n", index);
234	kfree(i2c);
235	return ret;
236	}
237
238	entry->chan = i2c;
239	return 0;
240	}
241
242	void
243	nouveau_i2c_fini(struct drm_device dev, struct dcb_i2c_entry entry)
244	{
245	if (!entry->chan)
246	return;
247
248	i2c_del_adapter(&entry->chan->adapter);
249	kfree(entry->chan);
250	entry->chan = NULL;
251	}
252
253	struct nouveau_i2c_chan *
254	nouveau_i2c_find(struct drm_device *dev, int index)
255	{
256	struct drm_nouveau_private *dev_priv = dev->dev_private;
7e99a9b2	257	struct dcb_i2c_entry *i2c = &dev_priv->vbios.dcb.i2c[index];
6ee73861	258
b762b8ce	259	if (index >= DCB_MAX_NUM_I2C_ENTRIES)
6ee73861 BS	260	return NULL;
6ee73861 BS	261
7e99a9b2 BS	262	if (dev_priv->chipset >= NV_50 && (i2c->entry & 0x00000100)) {
	263	uint32_t reg = 0xe500, val;
	264
	265	if (i2c->port_type == 6) {
	266	reg += i2c->read * 0x50;
	267	val = 0x2002;
	268	} else {
	269	reg += ((i2c->entry & 0x1e00) >> 9) * 0x50;
	270	val = 0xe001;
	271	}
	272
	273	nv_wr32(dev, reg, (nv_rd32(dev, reg) & ~0xf003) \| val);
6ee73861 BS	274	}
6ee73861 BS	275
7e99a9b2 BS	276	if (!i2c->chan && nouveau_i2c_init(dev, i2c, index))
	277	return NULL;
	278	return i2c->chan;
6ee73861 BS	279	}
6ee73861 BS	280
6d416d80 FJ	281	bool
	282	nouveau_probe_i2c_addr(struct nouveau_i2c_chan *i2c, int addr)
	283	{
f1feda70 FJ	284	uint8_t buf[] = { 0 };
	285	struct i2c_msg msgs[] = {
	286	{
	287	.addr = addr,
	288	.flags = 0,
	289	.len = 1,
	290	.buf = buf,
	291	},
	292	{
	293	.addr = addr,
	294	.flags = I2C_M_RD,
	295	.len = 1,
	296	.buf = buf,
	297	}
6d416d80 FJ	298	};
6d416d80 FJ	299
f1feda70	300	return i2c_transfer(&i2c->adapter, msgs, 2) == 2;
6d416d80 FJ	301	}
	302
	303	int
	304	nouveau_i2c_identify(struct drm_device dev, const char what,
	305	struct i2c_board_info *info, int index)
	306	{
	307	struct nouveau_i2c_chan *i2c = nouveau_i2c_find(dev, index);
946fd35f	308	int i;
6d416d80	309
6d416d80 FJ	310	NV_DEBUG(dev, "Probing %ss on I2C bus: %d\n", what, index);
	311
	312	for (i = 0; info[i].addr; i++) {
	313	if (nouveau_probe_i2c_addr(i2c, info[i].addr)) {
	314	NV_INFO(dev, "Detected %s: %s\n", what, info[i].type);
946fd35f	315	return i;
6d416d80 FJ	316	}
	317	}
	318
	319	NV_DEBUG(dev, "No devices found.\n");
6d416d80	320
946fd35f	321	return -ENODEV;
6d416d80	322	}