drivers/gpu/drm/nouveau/core/subdev/i2c/base.c - manifest_repos/salami - Git at Google

 /*
  * Copyright 2012 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 "core/option.h"

 #include "subdev/i2c.h"
 #include "subdev/vga.h"

 int
 nv_rdi2cr(struct nouveau_i2c_port *port, u8 addr, u8 reg)
 {
 	u8 val;
 	struct i2c_msg msgs[] = {
 		{ .addr = addr, .flags = 0, .len = 1, .buf = &reg },
 		{ .addr = addr, .flags = I2C_M_RD, .len = 1, .buf = &val },
 	};

 	int ret = i2c_transfer(&port->adapter, msgs, 2);
 	if (ret != 2)
 		return -EIO;

 	return val;
 }

 int
 nv_wri2cr(struct nouveau_i2c_port *port, u8 addr, u8 reg, u8 val)
 {
 	struct i2c_msg msgs[] = {
 		{ .addr = addr, .flags = 0, .len = 1, .buf = &reg },
 		{ .addr = addr, .flags = 0, .len = 1, .buf = &val },
 	};

 	int ret = i2c_transfer(&port->adapter, msgs, 2);
 	if (ret != 2)
 		return -EIO;

 	return 0;
 }

 bool
 nv_probe_i2c(struct nouveau_i2c_port *port, u8 addr)
 {
 	u8 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(&port->adapter, msgs, 2) == 2;
 }

 static struct nouveau_i2c_port *
 nouveau_i2c_find(struct nouveau_i2c *i2c, u8 index)
 {
 	struct nouveau_bios *bios = nouveau_bios(i2c);
 	struct nouveau_i2c_port *port;

 	if (index == NV_I2C_DEFAULT(0) ||
 	    index == NV_I2C_DEFAULT(1)) {
 		u8  ver, hdr, cnt, len;
 		u16 i2c = dcb_i2c_table(bios, &ver, &hdr, &cnt, &len);
 		if (i2c && ver >= 0x30) {
 			u8 auxidx = nv_ro08(bios, i2c + 4);
 			if (index == NV_I2C_DEFAULT(0))
 				index = (auxidx & 0x0f) >> 0;
 			else
 				index = (auxidx & 0xf0) >> 4;
 		} else {
 			index = 2;
 		}
 	}

 	list_for_each_entry(port, &i2c->ports, head) {
 		if (port->index == index)
 			break;
 	}

 	if (&port->head == &i2c->ports)
 		return NULL;

 	if (nv_device(i2c)->card_type >= NV_50 && (port->dcb & 0x00000100)) {
 		u32 reg = 0x00e500, val;
 		if (port->type == 6) {
 			reg += port->drive * 0x50;
 			val  = 0x2002;
 		} else {
 			reg += ((port->dcb & 0x1e00) >> 9) * 0x50;
 			val  = 0xe001;
 		}

 		/* nfi, but neither auxch or i2c work if it's 1 */
 		nv_mask(i2c, reg + 0x0c, 0x00000001, 0x00000000);
 		/* nfi, but switches auxch vs normal i2c */
 		nv_mask(i2c, reg + 0x00, 0x0000f003, val);
 	}

 	return port;
 }

 static int
 nouveau_i2c_identify(struct nouveau_i2c *i2c, int index, const char *what,
 		     struct i2c_board_info *info,
 		     bool (*match)(struct nouveau_i2c_port *,
 				   struct i2c_board_info *))
 {
 	struct nouveau_i2c_port *port = nouveau_i2c_find(i2c, index);
 	int i;

 	if (!port) {
 		nv_debug(i2c, "no bus when probing %s on %d\n", what, index);
 		return -ENODEV;
 	}

 	nv_debug(i2c, "probing %ss on bus: %d\n", what, port->index);
 	for (i = 0; info[i].addr; i++) {
 		if (nv_probe_i2c(port, info[i].addr) &&
 		    (!match || match(port, &info[i]))) {
 			nv_info(i2c, "detected %s: %s\n", what, info[i].type);
 			return i;
 		}
 	}

 	nv_debug(i2c, "no devices found.\n");
 	return -ENODEV;
 }

 void
 nouveau_i2c_drive_scl(void *data, int state)
 {
 	struct nouveau_i2c_port *port = data;

 	if (port->type == DCB_I2C_NV04_BIT) {
 		u8 val = nv_rdvgac(port->i2c, 0, port->drive);
 		if (state) val |= 0x20;
 		else	   val &= 0xdf;
 		nv_wrvgac(port->i2c, 0, port->drive, val | 0x01);
 	} else
 	if (port->type == DCB_I2C_NV4E_BIT) {
 		nv_mask(port->i2c, port->drive, 0x2f, state ? 0x21 : 0x01);
 	} else
 	if (port->type == DCB_I2C_NVIO_BIT) {
 		if (state) port->state |= 0x01;
 		else	   port->state &= 0xfe;
 		nv_wr32(port->i2c, port->drive, 4 | port->state);
 	}
 }

 void
 nouveau_i2c_drive_sda(void *data, int state)
 {
 	struct nouveau_i2c_port *port = data;

 	if (port->type == DCB_I2C_NV04_BIT) {
 		u8 val = nv_rdvgac(port->i2c, 0, port->drive);
 		if (state) val |= 0x10;
 		else	   val &= 0xef;
 		nv_wrvgac(port->i2c, 0, port->drive, val | 0x01);
 	} else
 	if (port->type == DCB_I2C_NV4E_BIT) {
 		nv_mask(port->i2c, port->drive, 0x1f, state ? 0x11 : 0x01);
 	} else
 	if (port->type == DCB_I2C_NVIO_BIT) {
 		if (state) port->state |= 0x02;
 		else	   port->state &= 0xfd;
 		nv_wr32(port->i2c, port->drive, 4 | port->state);
 	}
 }

 int
 nouveau_i2c_sense_scl(void *data)
 {
 	struct nouveau_i2c_port *port = data;
 	struct nouveau_device *device = nv_device(port->i2c);

 	if (port->type == DCB_I2C_NV04_BIT) {
 		return !!(nv_rdvgac(port->i2c, 0, port->sense) & 0x04);
 	} else
 	if (port->type == DCB_I2C_NV4E_BIT) {
 		return !!(nv_rd32(port->i2c, port->sense) & 0x00040000);
 	} else
 	if (port->type == DCB_I2C_NVIO_BIT) {
 		if (device->card_type < NV_D0)
 			return !!(nv_rd32(port->i2c, port->sense) & 0x01);
 		else
 			return !!(nv_rd32(port->i2c, port->sense) & 0x10);
 	}

 	return 0;
 }

 int
 nouveau_i2c_sense_sda(void *data)
 {
 	struct nouveau_i2c_port *port = data;
 	struct nouveau_device *device = nv_device(port->i2c);

 	if (port->type == DCB_I2C_NV04_BIT) {
 		return !!(nv_rdvgac(port->i2c, 0, port->sense) & 0x08);
 	} else
 	if (port->type == DCB_I2C_NV4E_BIT) {
 		return !!(nv_rd32(port->i2c, port->sense) & 0x00080000);
 	} else
 	if (port->type == DCB_I2C_NVIO_BIT) {
 		if (device->card_type < NV_D0)
 			return !!(nv_rd32(port->i2c, port->sense) & 0x02);
 		else
 			return !!(nv_rd32(port->i2c, port->sense) & 0x20);
 	}

 	return 0;
 }

 static const u32 nv50_i2c_port[] = {
 	0x00e138, 0x00e150, 0x00e168, 0x00e180,
 	0x00e254, 0x00e274, 0x00e764, 0x00e780,
 	0x00e79c, 0x00e7b8
 };

 static int
 nouveau_i2c_ctor(struct nouveau_object *parent, struct nouveau_object *engine,
 		 struct nouveau_oclass *oclass, void *data, u32 size,
 		 struct nouveau_object **pobject)
 {
 	struct nouveau_device *device = nv_device(parent);
 	struct nouveau_bios *bios = nouveau_bios(parent);
 	struct nouveau_i2c_port *port;
 	struct nouveau_i2c *i2c;
 	struct dcb_i2c_entry info;
 	int ret, i = -1;

 	ret = nouveau_subdev_create(parent, engine, oclass, 0,
 				    "I2C", "i2c", &i2c);
 	*pobject = nv_object(i2c);
 	if (ret)
 		return ret;

 	i2c->find = nouveau_i2c_find;
 	i2c->identify = nouveau_i2c_identify;
 	INIT_LIST_HEAD(&i2c->ports);

 	while (!dcb_i2c_parse(bios, ++i, &info)) {
 		if (info.type == DCB_I2C_UNUSED)
 			continue;

 		port = kzalloc(sizeof(*port), GFP_KERNEL);
 		if (!port) {
 			nv_error(i2c, "failed port memory alloc at %d\n", i);
 			break;
 		}

 		port->type = info.type;
 		switch (port->type) {
 		case DCB_I2C_NV04_BIT:
 			port->drive = info.drive;
 			port->sense = info.sense;
 			break;
 		case DCB_I2C_NV4E_BIT:
 			port->drive = 0x600800 + info.drive;
 			port->sense = port->drive;
 			break;
 		case DCB_I2C_NVIO_BIT:
 			port->drive = info.drive & 0x0f;
 			if (device->card_type < NV_D0) {
 				if (port->drive >= ARRAY_SIZE(nv50_i2c_port))
 					break;
 				port->drive = nv50_i2c_port[port->drive];
 				port->sense = port->drive;
 			} else {
 				port->drive = 0x00d014 + (port->drive * 0x20);
 				port->sense = port->drive;
 			}
 			break;
 		case DCB_I2C_NVIO_AUX:
 			port->drive = info.drive & 0x0f;
 			port->sense = port->drive;
 			port->adapter.algo = &nouveau_i2c_aux_algo;
 			break;
 		default:
 			break;
 		}

 		if (!port->adapter.algo && !port->drive) {
 			nv_error(i2c, "I2C%d: type %d index %x/%x unknown\n",
 				 i, port->type, port->drive, port->sense);
 			kfree(port);
 			continue;
 		}

 		snprintf(port->adapter.name, sizeof(port->adapter.name),
 			 "nouveau-%s-%d", device->name, i);
 		port->adapter.owner = THIS_MODULE;
 		port->adapter.dev.parent = &device->pdev->dev;
 		port->i2c = i2c;
 		port->index = i;
 		port->dcb = info.data;
 		i2c_set_adapdata(&port->adapter, i2c);

 		if (port->adapter.algo != &nouveau_i2c_aux_algo) {
 			nouveau_i2c_drive_scl(port, 0);
 			nouveau_i2c_drive_sda(port, 1);
 			nouveau_i2c_drive_scl(port, 1);

 #ifdef CONFIG_NOUVEAU_I2C_INTERNAL_DEFAULT
 			if (nouveau_boolopt(device->cfgopt, "NvI2C", true)) {
 #else
 			if (nouveau_boolopt(device->cfgopt, "NvI2C", false)) {
 #endif
 				port->adapter.algo = &nouveau_i2c_bit_algo;
 				ret = i2c_add_adapter(&port->adapter);
 			} else {
 				port->adapter.algo_data = &port->bit;
 				port->bit.udelay = 10;
 				port->bit.timeout = usecs_to_jiffies(2200);
 				port->bit.data = port;
 				port->bit.setsda = nouveau_i2c_drive_sda;
 				port->bit.setscl = nouveau_i2c_drive_scl;
 				port->bit.getsda = nouveau_i2c_sense_sda;
 				port->bit.getscl = nouveau_i2c_sense_scl;
 				ret = i2c_bit_add_bus(&port->adapter);
 			}
 		} else {
 			port->adapter.algo = &nouveau_i2c_aux_algo;
 			ret = i2c_add_adapter(&port->adapter);
 		}

 		if (ret) {
 			nv_error(i2c, "I2C%d: failed register: %d\n", i, ret);
 			kfree(port);
 			continue;
 		}

 		list_add_tail(&port->head, &i2c->ports);
 	}

 	return 0;
 }

 static void
 nouveau_i2c_dtor(struct nouveau_object *object)
 {
 	struct nouveau_i2c *i2c = (void *)object;
 	struct nouveau_i2c_port *port, *temp;

 	list_for_each_entry_safe(port, temp, &i2c->ports, head) {
 		i2c_del_adapter(&port->adapter);
 		list_del(&port->head);
 		kfree(port);
 	}

 	nouveau_subdev_destroy(&i2c->base);
 }

 static int
 nouveau_i2c_init(struct nouveau_object *object)
 {
 	struct nouveau_i2c *i2c = (void *)object;
 	return nouveau_subdev_init(&i2c->base);
 }

 static int
 nouveau_i2c_fini(struct nouveau_object *object, bool suspend)
 {
 	struct nouveau_i2c *i2c = (void *)object;
 	return nouveau_subdev_fini(&i2c->base, suspend);
 }

 struct nouveau_oclass
 nouveau_i2c_oclass = {
 	.handle = NV_SUBDEV(I2C, 0x00),
 	.ofuncs = &(struct nouveau_ofuncs) {
 		.ctor = nouveau_i2c_ctor,
 		.dtor = nouveau_i2c_dtor,
 		.init = nouveau_i2c_init,
 		.fini = nouveau_i2c_fini,
 	},
 };
	/*
	* Copyright 2012 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 "core/option.h"

	#include "subdev/i2c.h"
	#include "subdev/vga.h"

	int
	nv_rdi2cr(struct nouveau_i2c_port *port, u8 addr, u8 reg)
	{
	u8 val;
	struct i2c_msg msgs[] = {
	{ .addr = addr, .flags = 0, .len = 1, .buf = &reg },
	{ .addr = addr, .flags = I2C_M_RD, .len = 1, .buf = &val },
	};

	int ret = i2c_transfer(&port->adapter, msgs, 2);
	if (ret != 2)
	return -EIO;

	return val;
	}

	int
	nv_wri2cr(struct nouveau_i2c_port *port, u8 addr, u8 reg, u8 val)
	{
	struct i2c_msg msgs[] = {
	{ .addr = addr, .flags = 0, .len = 1, .buf = &reg },
	{ .addr = addr, .flags = 0, .len = 1, .buf = &val },
	};

	int ret = i2c_transfer(&port->adapter, msgs, 2);
	if (ret != 2)
	return -EIO;

	return 0;
	}

	bool
	nv_probe_i2c(struct nouveau_i2c_port *port, u8 addr)
	{
	u8 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(&port->adapter, msgs, 2) == 2;
	}

	static struct nouveau_i2c_port *
	nouveau_i2c_find(struct nouveau_i2c *i2c, u8 index)
	{
	struct nouveau_bios *bios = nouveau_bios(i2c);
	struct nouveau_i2c_port *port;

	if (index == NV_I2C_DEFAULT(0) \|\|
	index == NV_I2C_DEFAULT(1)) {
	u8 ver, hdr, cnt, len;
	u16 i2c = dcb_i2c_table(bios, &ver, &hdr, &cnt, &len);
	if (i2c && ver >= 0x30) {
	u8 auxidx = nv_ro08(bios, i2c + 4);
	if (index == NV_I2C_DEFAULT(0))
	index = (auxidx & 0x0f) >> 0;
	else
	index = (auxidx & 0xf0) >> 4;
	} else {
	index = 2;
	}
	}

	list_for_each_entry(port, &i2c->ports, head) {
	if (port->index == index)
	break;
	}

	if (&port->head == &i2c->ports)
	return NULL;

	if (nv_device(i2c)->card_type >= NV_50 && (port->dcb & 0x00000100)) {
	u32 reg = 0x00e500, val;
	if (port->type == 6) {
	reg += port->drive * 0x50;
	val = 0x2002;
	} else {
	reg += ((port->dcb & 0x1e00) >> 9) * 0x50;
	val = 0xe001;
	}

	/* nfi, but neither auxch or i2c work if it's 1 */
	nv_mask(i2c, reg + 0x0c, 0x00000001, 0x00000000);
	/* nfi, but switches auxch vs normal i2c */
	nv_mask(i2c, reg + 0x00, 0x0000f003, val);
	}

	return port;
	}

	static int
	nouveau_i2c_identify(struct nouveau_i2c i2c, int index, const char what,
	struct i2c_board_info *info,
	bool (match)(struct nouveau_i2c_port ,
	struct i2c_board_info *))
	{
	struct nouveau_i2c_port *port = nouveau_i2c_find(i2c, index);
	int i;

	if (!port) {
	nv_debug(i2c, "no bus when probing %s on %d\n", what, index);
	return -ENODEV;
	}

	nv_debug(i2c, "probing %ss on bus: %d\n", what, port->index);
	for (i = 0; info[i].addr; i++) {
	if (nv_probe_i2c(port, info[i].addr) &&
	(!match \|\| match(port, &info[i]))) {
	nv_info(i2c, "detected %s: %s\n", what, info[i].type);
	return i;
	}
	}

	nv_debug(i2c, "no devices found.\n");
	return -ENODEV;
	}

	void
	nouveau_i2c_drive_scl(void *data, int state)
	{
	struct nouveau_i2c_port *port = data;

	if (port->type == DCB_I2C_NV04_BIT) {
	u8 val = nv_rdvgac(port->i2c, 0, port->drive);
	if (state) val \|= 0x20;
	else val &= 0xdf;
	nv_wrvgac(port->i2c, 0, port->drive, val \| 0x01);
	} else
	if (port->type == DCB_I2C_NV4E_BIT) {
	nv_mask(port->i2c, port->drive, 0x2f, state ? 0x21 : 0x01);
	} else
	if (port->type == DCB_I2C_NVIO_BIT) {
	if (state) port->state \|= 0x01;
	else port->state &= 0xfe;
	nv_wr32(port->i2c, port->drive, 4 \| port->state);
	}
	}

	void
	nouveau_i2c_drive_sda(void *data, int state)
	{
	struct nouveau_i2c_port *port = data;

	if (port->type == DCB_I2C_NV04_BIT) {
	u8 val = nv_rdvgac(port->i2c, 0, port->drive);
	if (state) val \|= 0x10;
	else val &= 0xef;
	nv_wrvgac(port->i2c, 0, port->drive, val \| 0x01);
	} else
	if (port->type == DCB_I2C_NV4E_BIT) {
	nv_mask(port->i2c, port->drive, 0x1f, state ? 0x11 : 0x01);
	} else
	if (port->type == DCB_I2C_NVIO_BIT) {
	if (state) port->state \|= 0x02;
	else port->state &= 0xfd;
	nv_wr32(port->i2c, port->drive, 4 \| port->state);
	}
	}

	int
	nouveau_i2c_sense_scl(void *data)
	{
	struct nouveau_i2c_port *port = data;
	struct nouveau_device *device = nv_device(port->i2c);

	if (port->type == DCB_I2C_NV04_BIT) {
	return !!(nv_rdvgac(port->i2c, 0, port->sense) & 0x04);
	} else
	if (port->type == DCB_I2C_NV4E_BIT) {
	return !!(nv_rd32(port->i2c, port->sense) & 0x00040000);
	} else
	if (port->type == DCB_I2C_NVIO_BIT) {
	if (device->card_type < NV_D0)
	return !!(nv_rd32(port->i2c, port->sense) & 0x01);
	else
	return !!(nv_rd32(port->i2c, port->sense) & 0x10);
	}

	return 0;
	}

	int
	nouveau_i2c_sense_sda(void *data)
	{
	struct nouveau_i2c_port *port = data;
	struct nouveau_device *device = nv_device(port->i2c);

	if (port->type == DCB_I2C_NV04_BIT) {
	return !!(nv_rdvgac(port->i2c, 0, port->sense) & 0x08);
	} else
	if (port->type == DCB_I2C_NV4E_BIT) {
	return !!(nv_rd32(port->i2c, port->sense) & 0x00080000);
	} else
	if (port->type == DCB_I2C_NVIO_BIT) {
	if (device->card_type < NV_D0)
	return !!(nv_rd32(port->i2c, port->sense) & 0x02);
	else
	return !!(nv_rd32(port->i2c, port->sense) & 0x20);
	}

	return 0;
	}

	static const u32 nv50_i2c_port[] = {
	0x00e138, 0x00e150, 0x00e168, 0x00e180,
	0x00e254, 0x00e274, 0x00e764, 0x00e780,
	0x00e79c, 0x00e7b8
	};

	static int
	nouveau_i2c_ctor(struct nouveau_object parent, struct nouveau_object engine,
	struct nouveau_oclass oclass, void data, u32 size,
	struct nouveau_object **pobject)
	{
	struct nouveau_device *device = nv_device(parent);
	struct nouveau_bios *bios = nouveau_bios(parent);
	struct nouveau_i2c_port *port;
	struct nouveau_i2c *i2c;
	struct dcb_i2c_entry info;
	int ret, i = -1;

	ret = nouveau_subdev_create(parent, engine, oclass, 0,
	"I2C", "i2c", &i2c);
	*pobject = nv_object(i2c);
	if (ret)
	return ret;

	i2c->find = nouveau_i2c_find;
	i2c->identify = nouveau_i2c_identify;
	INIT_LIST_HEAD(&i2c->ports);

	while (!dcb_i2c_parse(bios, ++i, &info)) {
	if (info.type == DCB_I2C_UNUSED)
	continue;

	port = kzalloc(sizeof(*port), GFP_KERNEL);
	if (!port) {
	nv_error(i2c, "failed port memory alloc at %d\n", i);
	break;
	}

	port->type = info.type;
	switch (port->type) {
	case DCB_I2C_NV04_BIT:
	port->drive = info.drive;
	port->sense = info.sense;
	break;
	case DCB_I2C_NV4E_BIT:
	port->drive = 0x600800 + info.drive;
	port->sense = port->drive;
	break;
	case DCB_I2C_NVIO_BIT:
	port->drive = info.drive & 0x0f;
	if (device->card_type < NV_D0) {
	if (port->drive >= ARRAY_SIZE(nv50_i2c_port))
	break;
	port->drive = nv50_i2c_port[port->drive];
	port->sense = port->drive;
	} else {
	port->drive = 0x00d014 + (port->drive * 0x20);
	port->sense = port->drive;
	}
	break;
	case DCB_I2C_NVIO_AUX:
	port->drive = info.drive & 0x0f;
	port->sense = port->drive;
	port->adapter.algo = &nouveau_i2c_aux_algo;
	break;
	default:
	break;
	}

	if (!port->adapter.algo && !port->drive) {
	nv_error(i2c, "I2C%d: type %d index %x/%x unknown\n",
	i, port->type, port->drive, port->sense);
	kfree(port);
	continue;
	}

	snprintf(port->adapter.name, sizeof(port->adapter.name),
	"nouveau-%s-%d", device->name, i);
	port->adapter.owner = THIS_MODULE;
	port->adapter.dev.parent = &device->pdev->dev;
	port->i2c = i2c;
	port->index = i;
	port->dcb = info.data;
	i2c_set_adapdata(&port->adapter, i2c);

	if (port->adapter.algo != &nouveau_i2c_aux_algo) {
	nouveau_i2c_drive_scl(port, 0);
	nouveau_i2c_drive_sda(port, 1);
	nouveau_i2c_drive_scl(port, 1);

	#ifdef CONFIG_NOUVEAU_I2C_INTERNAL_DEFAULT
	if (nouveau_boolopt(device->cfgopt, "NvI2C", true)) {
	#else
	if (nouveau_boolopt(device->cfgopt, "NvI2C", false)) {
	#endif
	port->adapter.algo = &nouveau_i2c_bit_algo;
	ret = i2c_add_adapter(&port->adapter);
	} else {
	port->adapter.algo_data = &port->bit;
	port->bit.udelay = 10;
	port->bit.timeout = usecs_to_jiffies(2200);
	port->bit.data = port;
	port->bit.setsda = nouveau_i2c_drive_sda;
	port->bit.setscl = nouveau_i2c_drive_scl;
	port->bit.getsda = nouveau_i2c_sense_sda;
	port->bit.getscl = nouveau_i2c_sense_scl;
	ret = i2c_bit_add_bus(&port->adapter);
	}
	} else {
	port->adapter.algo = &nouveau_i2c_aux_algo;
	ret = i2c_add_adapter(&port->adapter);
	}

	if (ret) {
	nv_error(i2c, "I2C%d: failed register: %d\n", i, ret);
	kfree(port);
	continue;
	}

	list_add_tail(&port->head, &i2c->ports);
	}

	return 0;
	}

	static void
	nouveau_i2c_dtor(struct nouveau_object *object)
	{
	struct nouveau_i2c i2c = (void )object;
	struct nouveau_i2c_port port, temp;

	list_for_each_entry_safe(port, temp, &i2c->ports, head) {
	i2c_del_adapter(&port->adapter);
	list_del(&port->head);
	kfree(port);
	}

	nouveau_subdev_destroy(&i2c->base);
	}

	static int
	nouveau_i2c_init(struct nouveau_object *object)
	{
	struct nouveau_i2c i2c = (void )object;
	return nouveau_subdev_init(&i2c->base);
	}

	static int
	nouveau_i2c_fini(struct nouveau_object *object, bool suspend)
	{
	struct nouveau_i2c i2c = (void )object;
	return nouveau_subdev_fini(&i2c->base, suspend);
	}

	struct nouveau_oclass
	nouveau_i2c_oclass = {
	.handle = NV_SUBDEV(I2C, 0x00),
	.ofuncs = &(struct nouveau_ofuncs) {
	.ctor = nouveau_i2c_ctor,
	.dtor = nouveau_i2c_dtor,
	.init = nouveau_i2c_init,
	.fini = nouveau_i2c_fini,
	},
	};