[net-next-2.6.git] / drivers / sbus / char / bbc_i2c.c

/* bbc_i2c.c: I2C low-level driver for BBC device on UltraSPARC-III
 *            platforms.
 *
 * Copyright (C) 2001, 2008 David S. Miller (davem@davemloft.net)
 */

#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/types.h>
#include <linux/slab.h>
#include <linux/sched.h>
#include <linux/wait.h>
#include <linux/delay.h>
#include <linux/init.h>
#include <linux/interrupt.h>
#include <linux/of.h>
#include <linux/of_device.h>
#include <asm/bbc.h>
#include <asm/io.h>

#include "bbc_i2c.h"

/* Convert this driver to use i2c bus layer someday... */
#define I2C_PCF_PIN	0x80
#define I2C_PCF_ESO	0x40
#define I2C_PCF_ES1	0x20
#define I2C_PCF_ES2	0x10
#define I2C_PCF_ENI	0x08
#define I2C_PCF_STA	0x04
#define I2C_PCF_STO	0x02
#define I2C_PCF_ACK	0x01

#define I2C_PCF_START    (I2C_PCF_PIN | I2C_PCF_ESO | I2C_PCF_ENI | I2C_PCF_STA | I2C_PCF_ACK)
#define I2C_PCF_STOP     (I2C_PCF_PIN | I2C_PCF_ESO | I2C_PCF_STO | I2C_PCF_ACK)
#define I2C_PCF_REPSTART (              I2C_PCF_ESO | I2C_PCF_STA | I2C_PCF_ACK)
#define I2C_PCF_IDLE     (I2C_PCF_PIN | I2C_PCF_ESO               | I2C_PCF_ACK)

#define I2C_PCF_INI 0x40   /* 1 if not initialized */
#define I2C_PCF_STS 0x20
#define I2C_PCF_BER 0x10
#define I2C_PCF_AD0 0x08
#define I2C_PCF_LRB 0x08
#define I2C_PCF_AAS 0x04
#define I2C_PCF_LAB 0x02
#define I2C_PCF_BB  0x01

/* The BBC devices have two I2C controllers.  The first I2C controller
 * connects mainly to configuration proms (NVRAM, cpu configuration,
 * dimm types, etc.).  Whereas the second I2C controller connects to
 * environmental control devices such as fans and temperature sensors.
 * The second controller also connects to the smartcard reader, if present.
 */

static void set_device_claimage(struct bbc_i2c_bus *bp, struct of_device *op, int val)
{
	int i;

	for (i = 0; i < NUM_CHILDREN; i++) {
		if (bp->devs[i].device == op) {
			bp->devs[i].client_claimed = val;
			return;
		}
	}
}

#define claim_device(BP,ECHILD)		set_device_claimage(BP,ECHILD,1)
#define release_device(BP,ECHILD)	set_device_claimage(BP,ECHILD,0)

struct of_device *bbc_i2c_getdev(struct bbc_i2c_bus *bp, int index)
{
	struct of_device *op = NULL;
	int curidx = 0, i;

	for (i = 0; i < NUM_CHILDREN; i++) {
		if (!(op = bp->devs[i].device))
			break;
		if (curidx == index)
			goto out;
		op = NULL;
		curidx++;
	}

out:
	if (curidx == index)
		return op;
	return NULL;
}

struct bbc_i2c_client *bbc_i2c_attach(struct bbc_i2c_bus *bp, struct of_device *op)
{
	struct bbc_i2c_client *client;
	const u32 *reg;

	client = kzalloc(sizeof(*client), GFP_KERNEL);
	if (!client)
		return NULL;
	client->bp = bp;
	client->op = op;

	reg = of_get_property(op->dev.of_node, "reg", NULL);
	if (!reg) {
		kfree(client);
		return NULL;
	}

	client->bus = reg[0];
	client->address = reg[1];

	claim_device(bp, op);

	return client;
}

void bbc_i2c_detach(struct bbc_i2c_client *client)
{
	struct bbc_i2c_bus *bp = client->bp;
	struct of_device *op = client->op;

	release_device(bp, op);
	kfree(client);
}

static int wait_for_pin(struct bbc_i2c_bus *bp, u8 *status)
{
	DECLARE_WAITQUEUE(wait, current);
	int limit = 32;
	int ret = 1;

	bp->waiting = 1;
	add_wait_queue(&bp->wq, &wait);
	while (limit-- > 0) {
		long val;

		val = wait_event_interruptible_timeout(
				bp->wq,
				(((*status = readb(bp->i2c_control_regs + 0))
				  & I2C_PCF_PIN) == 0),
				msecs_to_jiffies(250));
		if (val > 0) {
			ret = 0;
			break;
		}
	}
	remove_wait_queue(&bp->wq, &wait);
	bp->waiting = 0;

	return ret;
}

int bbc_i2c_writeb(struct bbc_i2c_client *client, unsigned char val, int off)
{
	struct bbc_i2c_bus *bp = client->bp;
	int address = client->address;
	u8 status;
	int ret = -1;

	if (bp->i2c_bussel_reg != NULL)
		writeb(client->bus, bp->i2c_bussel_reg);

	writeb(address, bp->i2c_control_regs + 0x1);
	writeb(I2C_PCF_START, bp->i2c_control_regs + 0x0);
	if (wait_for_pin(bp, &status))
		goto out;

	writeb(off, bp->i2c_control_regs + 0x1);
	if (wait_for_pin(bp, &status) ||
	    (status & I2C_PCF_LRB) != 0)
		goto out;

	writeb(val, bp->i2c_control_regs + 0x1);
	if (wait_for_pin(bp, &status))
		goto out;

	ret = 0;

out:
	writeb(I2C_PCF_STOP, bp->i2c_control_regs + 0x0);
	return ret;
}

int bbc_i2c_readb(struct bbc_i2c_client *client, unsigned char *byte, int off)
{
	struct bbc_i2c_bus *bp = client->bp;
	unsigned char address = client->address, status;
	int ret = -1;

	if (bp->i2c_bussel_reg != NULL)
		writeb(client->bus, bp->i2c_bussel_reg);

	writeb(address, bp->i2c_control_regs + 0x1);
	writeb(I2C_PCF_START, bp->i2c_control_regs + 0x0);
	if (wait_for_pin(bp, &status))
		goto out;

	writeb(off, bp->i2c_control_regs + 0x1);
	if (wait_for_pin(bp, &status) ||
	    (status & I2C_PCF_LRB) != 0)
		goto out;

	writeb(I2C_PCF_STOP, bp->i2c_control_regs + 0x0);

	address |= 0x1; /* READ */

	writeb(address, bp->i2c_control_regs + 0x1);
	writeb(I2C_PCF_START, bp->i2c_control_regs + 0x0);
	if (wait_for_pin(bp, &status))
		goto out;

	/* Set PIN back to one so the device sends the first
	 * byte.
	 */
	(void) readb(bp->i2c_control_regs + 0x1);
	if (wait_for_pin(bp, &status))
		goto out;

	writeb(I2C_PCF_ESO | I2C_PCF_ENI, bp->i2c_control_regs + 0x0);
	*byte = readb(bp->i2c_control_regs + 0x1);
	if (wait_for_pin(bp, &status))
		goto out;

	ret = 0;

out:
	writeb(I2C_PCF_STOP, bp->i2c_control_regs + 0x0);
	(void) readb(bp->i2c_control_regs + 0x1);

	return ret;
}

int bbc_i2c_write_buf(struct bbc_i2c_client *client,
		      char *buf, int len, int off)
{
	int ret = 0;

	while (len > 0) {
		int err = bbc_i2c_writeb(client, *buf, off);

		if (err < 0) {
			ret = err;
			break;
		}

		len--;
		buf++;
		off++;
	}
	return ret;
}

int bbc_i2c_read_buf(struct bbc_i2c_client *client,
		     char *buf, int len, int off)
{
	int ret = 0;

	while (len > 0) {
		int err = bbc_i2c_readb(client, buf, off);
		if (err < 0) {
			ret = err;
			break;
		}
		len--;
		buf++;
		off++;
	}

	return ret;
}

EXPORT_SYMBOL(bbc_i2c_getdev);
EXPORT_SYMBOL(bbc_i2c_attach);
EXPORT_SYMBOL(bbc_i2c_detach);
EXPORT_SYMBOL(bbc_i2c_writeb);
EXPORT_SYMBOL(bbc_i2c_readb);
EXPORT_SYMBOL(bbc_i2c_write_buf);
EXPORT_SYMBOL(bbc_i2c_read_buf);

static irqreturn_t bbc_i2c_interrupt(int irq, void *dev_id)
{
	struct bbc_i2c_bus *bp = dev_id;

	/* PIN going from set to clear is the only event which
	 * makes the i2c assert an interrupt.
	 */
	if (bp->waiting &&
	    !(readb(bp->i2c_control_regs + 0x0) & I2C_PCF_PIN))
		wake_up_interruptible(&bp->wq);

	return IRQ_HANDLED;
}

static void __init reset_one_i2c(struct bbc_i2c_bus *bp)
{
	writeb(I2C_PCF_PIN, bp->i2c_control_regs + 0x0);
	writeb(bp->own, bp->i2c_control_regs + 0x1);
	writeb(I2C_PCF_PIN | I2C_PCF_ES1, bp->i2c_control_regs + 0x0);
	writeb(bp->clock, bp->i2c_control_regs + 0x1);
	writeb(I2C_PCF_IDLE, bp->i2c_control_regs + 0x0);
}

static struct bbc_i2c_bus * __init attach_one_i2c(struct of_device *op, int index)
{
	struct bbc_i2c_bus *bp;
	struct device_node *dp;
	int entry;

	bp = kzalloc(sizeof(*bp), GFP_KERNEL);
	if (!bp)
		return NULL;

	bp->i2c_control_regs = of_ioremap(&op->resource[0], 0, 0x2, "bbc_i2c_regs");
	if (!bp->i2c_control_regs)
		goto fail;

	bp->i2c_bussel_reg = of_ioremap(&op->resource[1], 0, 0x1, "bbc_i2c_bussel");
	if (!bp->i2c_bussel_reg)
		goto fail;

	bp->waiting = 0;
	init_waitqueue_head(&bp->wq);
	if (request_irq(op->archdata.irqs[0], bbc_i2c_interrupt,
			IRQF_SHARED, "bbc_i2c", bp))
		goto fail;

	bp->index = index;
	bp->op = op;

	spin_lock_init(&bp->lock);

	entry = 0;
	for (dp = op->dev.of_node->child;
	     dp && entry < 8;
	     dp = dp->sibling, entry++) {
		struct of_device *child_op;

		child_op = of_find_device_by_node(dp);
		bp->devs[entry].device = child_op;
		bp->devs[entry].client_claimed = 0;
	}

	writeb(I2C_PCF_PIN, bp->i2c_control_regs + 0x0);
	bp->own = readb(bp->i2c_control_regs + 0x01);
	writeb(I2C_PCF_PIN | I2C_PCF_ES1, bp->i2c_control_regs + 0x0);
	bp->clock = readb(bp->i2c_control_regs + 0x01);

	printk(KERN_INFO "i2c-%d: Regs at %p, %d devices, own %02x, clock %02x.\n",
	       bp->index, bp->i2c_control_regs, entry, bp->own, bp->clock);

	reset_one_i2c(bp);

	return bp;

fail:
	if (bp->i2c_bussel_reg)
		of_iounmap(&op->resource[1], bp->i2c_bussel_reg, 1);
	if (bp->i2c_control_regs)
		of_iounmap(&op->resource[0], bp->i2c_control_regs, 2);
	kfree(bp);
	return NULL;
}

extern int bbc_envctrl_init(struct bbc_i2c_bus *bp);
extern void bbc_envctrl_cleanup(struct bbc_i2c_bus *bp);

static int __devinit bbc_i2c_probe(struct of_device *op,
				   const struct of_device_id *match)
{
	struct bbc_i2c_bus *bp;
	int err, index = 0;

	bp = attach_one_i2c(op, index);
	if (!bp)
		return -EINVAL;

	err = bbc_envctrl_init(bp);
	if (err) {
		free_irq(op->archdata.irqs[0], bp);
		if (bp->i2c_bussel_reg)
			of_iounmap(&op->resource[0], bp->i2c_bussel_reg, 1);
		if (bp->i2c_control_regs)
			of_iounmap(&op->resource[1], bp->i2c_control_regs, 2);
		kfree(bp);
	} else {
		dev_set_drvdata(&op->dev, bp);
	}

	return err;
}

static int __devexit bbc_i2c_remove(struct of_device *op)
{
	struct bbc_i2c_bus *bp = dev_get_drvdata(&op->dev);

	bbc_envctrl_cleanup(bp);

	free_irq(op->archdata.irqs[0], bp);

	if (bp->i2c_bussel_reg)
		of_iounmap(&op->resource[0], bp->i2c_bussel_reg, 1);
	if (bp->i2c_control_regs)
		of_iounmap(&op->resource[1], bp->i2c_control_regs, 2);

	kfree(bp);

	return 0;
}

static const struct of_device_id bbc_i2c_match[] = {
	{
		.name = "i2c",
		.compatible = "SUNW,bbc-i2c",
	},
	{},
};
MODULE_DEVICE_TABLE(of, bbc_i2c_match);

static struct of_platform_driver bbc_i2c_driver = {
	.driver = {
		.name = "bbc_i2c",
		.owner = THIS_MODULE,
		.of_match_table = bbc_i2c_match,
	},
	.probe		= bbc_i2c_probe,
	.remove		= __devexit_p(bbc_i2c_remove),
};

static int __init bbc_i2c_init(void)
{
	return of_register_platform_driver(&bbc_i2c_driver);
}

static void __exit bbc_i2c_exit(void)
{
	of_unregister_platform_driver(&bbc_i2c_driver);
}

module_init(bbc_i2c_init);
module_exit(bbc_i2c_exit);

MODULE_LICENSE("GPL");
Commit	Line	Data
e21e245b	1	/* bbc_i2c.c: I2C low-level driver for BBC device on UltraSPARC-III
1da177e4 LT	2	* platforms.
1da177e4 LT	3	*
e21e245b	4	* Copyright (C) 2001, 2008 David S. Miller (davem@davemloft.net)
1da177e4 LT	5	*/
	6
	7	#include <linux/module.h>
	8	#include <linux/kernel.h>
	9	#include <linux/types.h>
	10	#include <linux/slab.h>
	11	#include <linux/sched.h>
	12	#include <linux/wait.h>
	13	#include <linux/delay.h>
	14	#include <linux/init.h>
	15	#include <linux/interrupt.h>
e21e245b DM	16	#include <linux/of.h>
e21e245b DM	17	#include <linux/of_device.h>
1da177e4	18	#include <asm/bbc.h>
4b5dff76	19	#include <asm/io.h>
1da177e4 LT	20
	21	#include "bbc_i2c.h"
	22
	23	/* Convert this driver to use i2c bus layer someday... */
	24	#define I2C_PCF_PIN 0x80
	25	#define I2C_PCF_ESO 0x40
	26	#define I2C_PCF_ES1 0x20
	27	#define I2C_PCF_ES2 0x10
	28	#define I2C_PCF_ENI 0x08
	29	#define I2C_PCF_STA 0x04
	30	#define I2C_PCF_STO 0x02
	31	#define I2C_PCF_ACK 0x01
	32
	33	#define I2C_PCF_START (I2C_PCF_PIN \| I2C_PCF_ESO \| I2C_PCF_ENI \| I2C_PCF_STA \| I2C_PCF_ACK)
	34	#define I2C_PCF_STOP (I2C_PCF_PIN \| I2C_PCF_ESO \| I2C_PCF_STO \| I2C_PCF_ACK)
	35	#define I2C_PCF_REPSTART ( I2C_PCF_ESO \| I2C_PCF_STA \| I2C_PCF_ACK)
	36	#define I2C_PCF_IDLE (I2C_PCF_PIN \| I2C_PCF_ESO \| I2C_PCF_ACK)
	37
	38	#define I2C_PCF_INI 0x40 /* 1 if not initialized */
	39	#define I2C_PCF_STS 0x20
	40	#define I2C_PCF_BER 0x10
	41	#define I2C_PCF_AD0 0x08
	42	#define I2C_PCF_LRB 0x08
	43	#define I2C_PCF_AAS 0x04
	44	#define I2C_PCF_LAB 0x02
	45	#define I2C_PCF_BB 0x01
	46
	47	/* The BBC devices have two I2C controllers. The first I2C controller
	48	* connects mainly to configuration proms (NVRAM, cpu configuration,
	49	* dimm types, etc.). Whereas the second I2C controller connects to
	50	* environmental control devices such as fans and temperature sensors.
	51	* The second controller also connects to the smartcard reader, if present.
	52	*/
	53
e21e245b	54	static void set_device_claimage(struct bbc_i2c_bus bp, struct of_device op, int val)
1da177e4 LT	55	{
	56	int i;
	57
	58	for (i = 0; i < NUM_CHILDREN; i++) {
e21e245b	59	if (bp->devs[i].device == op) {
1da177e4 LT	60	bp->devs[i].client_claimed = val;
	61	return;
	62	}
	63	}
	64	}
	65
	66	#define claim_device(BP,ECHILD) set_device_claimage(BP,ECHILD,1)
	67	#define release_device(BP,ECHILD) set_device_claimage(BP,ECHILD,0)
	68
e21e245b	69	struct of_device bbc_i2c_getdev(struct bbc_i2c_bus bp, int index)
1da177e4	70	{
e21e245b DM	71	struct of_device *op = NULL;
e21e245b DM	72	int curidx = 0, i;
1da177e4	73
e21e245b DM	74	for (i = 0; i < NUM_CHILDREN; i++) {
e21e245b DM	75	if (!(op = bp->devs[i].device))
1da177e4	76	break;
e21e245b DM	77	if (curidx == index)
	78	goto out;
	79	op = NULL;
	80	curidx++;
1da177e4 LT	81	}
1da177e4 LT	82
1da177e4 LT	83	out:
1da177e4 LT	84	if (curidx == index)
e21e245b	85	return op;
1da177e4 LT	86	return NULL;
	87	}
	88
e21e245b	89	struct bbc_i2c_client bbc_i2c_attach(struct bbc_i2c_bus bp, struct of_device *op)
1da177e4	90	{
1da177e4	91	struct bbc_i2c_client *client;
e21e245b	92	const u32 *reg;
1da177e4	93
dd00cc48	94	client = kzalloc(sizeof(*client), GFP_KERNEL);
1da177e4 LT	95	if (!client)
1da177e4 LT	96	return NULL;
1da177e4	97	client->bp = bp;
e21e245b DM	98	client->op = op;
e21e245b DM	99
61c7a080	100	reg = of_get_property(op->dev.of_node, "reg", NULL);
e21e245b DM	101	if (!reg) {
	102	kfree(client);
	103	return NULL;
	104	}
1da177e4	105
e21e245b DM	106	client->bus = reg[0];
	107	client->address = reg[1];
	108
	109	claim_device(bp, op);
1da177e4 LT	110
	111	return client;
	112	}
	113
	114	void bbc_i2c_detach(struct bbc_i2c_client *client)
	115	{
	116	struct bbc_i2c_bus *bp = client->bp;
e21e245b	117	struct of_device *op = client->op;
1da177e4	118
e21e245b	119	release_device(bp, op);
1da177e4 LT	120	kfree(client);
	121	}
	122
	123	static int wait_for_pin(struct bbc_i2c_bus bp, u8 status)
	124	{
	125	DECLARE_WAITQUEUE(wait, current);
	126	int limit = 32;
	127	int ret = 1;
	128
	129	bp->waiting = 1;
	130	add_wait_queue(&bp->wq, &wait);
	131	while (limit-- > 0) {
f4c13638	132	long val;
3b36fb84 DM	133
	134	val = wait_event_interruptible_timeout(
	135	bp->wq,
	136	(((*status = readb(bp->i2c_control_regs + 0))
	137	& I2C_PCF_PIN) == 0),
	138	msecs_to_jiffies(250));
	139	if (val > 0) {
1da177e4 LT	140	ret = 0;
	141	break;
	142	}
1da177e4 LT	143	}
	144	remove_wait_queue(&bp->wq, &wait);
	145	bp->waiting = 0;
1da177e4 LT	146
	147	return ret;
	148	}
	149
	150	int bbc_i2c_writeb(struct bbc_i2c_client *client, unsigned char val, int off)
	151	{
	152	struct bbc_i2c_bus *bp = client->bp;
	153	int address = client->address;
	154	u8 status;
	155	int ret = -1;
	156
	157	if (bp->i2c_bussel_reg != NULL)
	158	writeb(client->bus, bp->i2c_bussel_reg);
	159
	160	writeb(address, bp->i2c_control_regs + 0x1);
	161	writeb(I2C_PCF_START, bp->i2c_control_regs + 0x0);
	162	if (wait_for_pin(bp, &status))
	163	goto out;
	164
	165	writeb(off, bp->i2c_control_regs + 0x1);
	166	if (wait_for_pin(bp, &status) \|\|
	167	(status & I2C_PCF_LRB) != 0)
	168	goto out;
	169
	170	writeb(val, bp->i2c_control_regs + 0x1);
	171	if (wait_for_pin(bp, &status))
	172	goto out;
	173
	174	ret = 0;
	175
	176	out:
	177	writeb(I2C_PCF_STOP, bp->i2c_control_regs + 0x0);
	178	return ret;
	179	}
	180
	181	int bbc_i2c_readb(struct bbc_i2c_client client, unsigned char byte, int off)
	182	{
	183	struct bbc_i2c_bus *bp = client->bp;
	184	unsigned char address = client->address, status;
	185	int ret = -1;
	186
	187	if (bp->i2c_bussel_reg != NULL)
	188	writeb(client->bus, bp->i2c_bussel_reg);
	189
	190	writeb(address, bp->i2c_control_regs + 0x1);
	191	writeb(I2C_PCF_START, bp->i2c_control_regs + 0x0);
	192	if (wait_for_pin(bp, &status))
	193	goto out;
	194
	195	writeb(off, bp->i2c_control_regs + 0x1);
	196	if (wait_for_pin(bp, &status) \|\|
	197	(status & I2C_PCF_LRB) != 0)
	198	goto out;
	199
	200	writeb(I2C_PCF_STOP, bp->i2c_control_regs + 0x0);
	201
	202	address \|= 0x1; /* READ */
	203
	204	writeb(address, bp->i2c_control_regs + 0x1);
	205	writeb(I2C_PCF_START, bp->i2c_control_regs + 0x0);
	206	if (wait_for_pin(bp, &status))
	207	goto out;
	208
	209	/* Set PIN back to one so the device sends the first
210	* byte.
211	*/
212	(void) readb(bp->i2c_control_regs + 0x1);
213	if (wait_for_pin(bp, &status))
214	goto out;
215
216	writeb(I2C_PCF_ESO \| I2C_PCF_ENI, bp->i2c_control_regs + 0x0);
217	*byte = readb(bp->i2c_control_regs + 0x1);
218	if (wait_for_pin(bp, &status))
219	goto out;
220
221	ret = 0;
222
223	out:
224	writeb(I2C_PCF_STOP, bp->i2c_control_regs + 0x0);
225	(void) readb(bp->i2c_control_regs + 0x1);
226
227	return ret;
228	}
229
230	int bbc_i2c_write_buf(struct bbc_i2c_client *client,
231	char *buf, int len, int off)
232	{
233	int ret = 0;
234
235	while (len > 0) {
236	int err = bbc_i2c_writeb(client, *buf, off);
237
238	if (err < 0) {
239	ret = err;
240	break;
241	}
242
243	len--;
244	buf++;
245	off++;
246	}
247	return ret;
248	}
249
250	int bbc_i2c_read_buf(struct bbc_i2c_client *client,
251	char *buf, int len, int off)
252	{
253	int ret = 0;
254
255	while (len > 0) {
256	int err = bbc_i2c_readb(client, buf, off);
257	if (err < 0) {
258	ret = err;
259	break;
260	}
261	len--;
262	buf++;
263	off++;
264	}
265
266	return ret;
267	}
268
269	EXPORT_SYMBOL(bbc_i2c_getdev);
270	EXPORT_SYMBOL(bbc_i2c_attach);
271	EXPORT_SYMBOL(bbc_i2c_detach);
272	EXPORT_SYMBOL(bbc_i2c_writeb);
273	EXPORT_SYMBOL(bbc_i2c_readb);
274	EXPORT_SYMBOL(bbc_i2c_write_buf);
275	EXPORT_SYMBOL(bbc_i2c_read_buf);
276
7d12e780	277	static irqreturn_t bbc_i2c_interrupt(int irq, void *dev_id)
1da177e4 LT	278	{
	279	struct bbc_i2c_bus *bp = dev_id;
	280
	281	/* PIN going from set to clear is the only event which
	282	* makes the i2c assert an interrupt.
	283	*/
	284	if (bp->waiting &&
	285	!(readb(bp->i2c_control_regs + 0x0) & I2C_PCF_PIN))
3b36fb84	286	wake_up_interruptible(&bp->wq);
1da177e4 LT	287
	288	return IRQ_HANDLED;
	289	}
	290
	291	static void __init reset_one_i2c(struct bbc_i2c_bus *bp)
	292	{
	293	writeb(I2C_PCF_PIN, bp->i2c_control_regs + 0x0);
	294	writeb(bp->own, bp->i2c_control_regs + 0x1);
	295	writeb(I2C_PCF_PIN \| I2C_PCF_ES1, bp->i2c_control_regs + 0x0);
	296	writeb(bp->clock, bp->i2c_control_regs + 0x1);
	297	writeb(I2C_PCF_IDLE, bp->i2c_control_regs + 0x0);
	298	}
	299
e21e245b	300	static struct bbc_i2c_bus * __init attach_one_i2c(struct of_device *op, int index)
1da177e4	301	{
50aa485e	302	struct bbc_i2c_bus *bp;
e21e245b	303	struct device_node *dp;
1da177e4 LT	304	int entry;
1da177e4 LT	305
50aa485e	306	bp = kzalloc(sizeof(*bp), GFP_KERNEL);
1da177e4	307	if (!bp)
e21e245b	308	return NULL;
1da177e4	309
e21e245b	310	bp->i2c_control_regs = of_ioremap(&op->resource[0], 0, 0x2, "bbc_i2c_regs");
1da177e4 LT	311	if (!bp->i2c_control_regs)
	312	goto fail;
	313
e21e245b DM	314	bp->i2c_bussel_reg = of_ioremap(&op->resource[1], 0, 0x1, "bbc_i2c_bussel");
	315	if (!bp->i2c_bussel_reg)
	316	goto fail;
1da177e4 LT	317
	318	bp->waiting = 0;
	319	init_waitqueue_head(&bp->wq);
1636f8ac	320	if (request_irq(op->archdata.irqs[0], bbc_i2c_interrupt,
dace1453	321	IRQF_SHARED, "bbc_i2c", bp))
1da177e4 LT	322	goto fail;
	323
	324	bp->index = index;
e21e245b	325	bp->op = op;
1da177e4 LT	326
1da177e4 LT	327	spin_lock_init(&bp->lock);
1da177e4 LT	328
1da177e4 LT	329	entry = 0;
61c7a080	330	for (dp = op->dev.of_node->child;
e21e245b DM	331	dp && entry < 8;
	332	dp = dp->sibling, entry++) {
	333	struct of_device *child_op;
	334
	335	child_op = of_find_device_by_node(dp);
	336	bp->devs[entry].device = child_op;
1da177e4 LT	337	bp->devs[entry].client_claimed = 0;
	338	}
	339
	340	writeb(I2C_PCF_PIN, bp->i2c_control_regs + 0x0);
	341	bp->own = readb(bp->i2c_control_regs + 0x01);
	342	writeb(I2C_PCF_PIN \| I2C_PCF_ES1, bp->i2c_control_regs + 0x0);
	343	bp->clock = readb(bp->i2c_control_regs + 0x01);
	344
	345	printk(KERN_INFO "i2c-%d: Regs at %p, %d devices, own %02x, clock %02x.\n",
	346	bp->index, bp->i2c_control_regs, entry, bp->own, bp->clock);
	347
	348	reset_one_i2c(bp);
	349
e21e245b	350	return bp;
1da177e4 LT	351
	352	fail:
	353	if (bp->i2c_bussel_reg)
e21e245b	354	of_iounmap(&op->resource[1], bp->i2c_bussel_reg, 1);
1da177e4	355	if (bp->i2c_control_regs)
e21e245b	356	of_iounmap(&op->resource[0], bp->i2c_control_regs, 2);
1da177e4	357	kfree(bp);
e21e245b	358	return NULL;
1da177e4 LT	359	}
1da177e4 LT	360
e21e245b DM	361	extern int bbc_envctrl_init(struct bbc_i2c_bus *bp);
e21e245b DM	362	extern void bbc_envctrl_cleanup(struct bbc_i2c_bus *bp);
1da177e4	363
33b07db9	364	static int __devinit bbc_i2c_probe(struct of_device *op,
e21e245b	365	const struct of_device_id *match)
1da177e4	366	{
e21e245b	367	struct bbc_i2c_bus *bp;
1da177e4 LT	368	int err, index = 0;
1da177e4 LT	369
e21e245b DM	370	bp = attach_one_i2c(op, index);
	371	if (!bp)
	372	return -EINVAL;
1da177e4	373
e21e245b DM	374	err = bbc_envctrl_init(bp);
e21e245b DM	375	if (err) {
1636f8ac	376	free_irq(op->archdata.irqs[0], bp);
e21e245b DM	377	if (bp->i2c_bussel_reg)
	378	of_iounmap(&op->resource[0], bp->i2c_bussel_reg, 1);
	379	if (bp->i2c_control_regs)
	380	of_iounmap(&op->resource[1], bp->i2c_control_regs, 2);
	381	kfree(bp);
	382	} else {
	383	dev_set_drvdata(&op->dev, bp);
1da177e4 LT	384	}
1da177e4 LT	385
1da177e4 LT	386	return err;
	387	}
	388
33b07db9	389	static int __devexit bbc_i2c_remove(struct of_device *op)
1da177e4	390	{
e21e245b DM	391	struct bbc_i2c_bus *bp = dev_get_drvdata(&op->dev);
	392
	393	bbc_envctrl_cleanup(bp);
	394
1636f8ac	395	free_irq(op->archdata.irqs[0], bp);
1da177e4	396
e21e245b DM	397	if (bp->i2c_bussel_reg)
	398	of_iounmap(&op->resource[0], bp->i2c_bussel_reg, 1);
	399	if (bp->i2c_control_regs)
	400	of_iounmap(&op->resource[1], bp->i2c_control_regs, 2);
1da177e4	401
e21e245b	402	kfree(bp);
1da177e4	403
e21e245b DM	404	return 0;
e21e245b DM	405	}
1da177e4	406
fd098316	407	static const struct of_device_id bbc_i2c_match[] = {
e21e245b DM	408	{
	409	.name = "i2c",
	410	.compatible = "SUNW,bbc-i2c",
	411	},
	412	{},
	413	};
	414	MODULE_DEVICE_TABLE(of, bbc_i2c_match);
1da177e4	415
e21e245b	416	static struct of_platform_driver bbc_i2c_driver = {
4018294b GL	417	.driver = {
	418	.name = "bbc_i2c",
	419	.owner = THIS_MODULE,
	420	.of_match_table = bbc_i2c_match,
	421	},
e21e245b	422	.probe = bbc_i2c_probe,
33b07db9	423	.remove = __devexit_p(bbc_i2c_remove),
e21e245b	424	};
1da177e4	425
e21e245b DM	426	static int __init bbc_i2c_init(void)
e21e245b DM	427	{
1ab1d63a	428	return of_register_platform_driver(&bbc_i2c_driver);
e21e245b DM	429	}
	430
	431	static void __exit bbc_i2c_exit(void)
	432	{
1ab1d63a	433	of_unregister_platform_driver(&bbc_i2c_driver);
1da177e4 LT	434	}
	435
	436	module_init(bbc_i2c_init);
e21e245b DM	437	module_exit(bbc_i2c_exit);
e21e245b DM	438
b5e7ae5d	439	MODULE_LICENSE("GPL");