static int __devinit fsl_i2c_probe(struct of_device *op, const struct of_device_id *match)
{
int result = 0;
struct mpc_i2c *i2c;
i2c = kzalloc(sizeof(*i2c), GFP_KERNEL);
if (!i2c)
return -ENOMEM;
if (of_get_property(op->node, "dfsrr", NULL))
i2c->flags |= FSL_I2C_DEV_SEPARATE_DFSRR;
if (of_device_is_compatible(op->node, "fsl,mpc5200-i2c") ||
of_device_is_compatible(op->node, "mpc5200-i2c"))
i2c->flags |= FSL_I2C_DEV_CLOCK_5200;
init_waitqueue_head(&i2c->queue);
i2c->base = of_iomap(op->node, 0);
if (!i2c->base) {
printk(KERN_ERR "i2c-mpc - failed to map controller\n");
result = -ENOMEM;
goto fail_map;
}
i2c->irq = irq_of_parse_and_map(op->node, 0);
if (i2c->irq != NO_IRQ) { /* i2c->irq = NO_IRQ implies polling */
result = request_irq(i2c->irq, mpc_i2c_isr,
IRQF_SHARED, "i2c-mpc", i2c);
if (result < 0) {
printk(KERN_ERR "i2c-mpc - failed to attach interrupt\n");
goto fail_request;
}
}
mpc_i2c_setclock(i2c);
dev_set_drvdata(&op->dev, i2c);
i2c->adap = mpc_ops;
i2c_set_adapdata(&i2c->adap, i2c);
i2c->adap.dev.parent = &op->dev;
result = i2c_add_adapter(&i2c->adap);
if (result < 0) {
printk(KERN_ERR "i2c-mpc - failed to add adapter\n");
goto fail_add;
}
of_register_i2c_devices(&i2c->adap, op->node);
return result;
fail_add:
dev_set_drvdata(&op->dev, NULL);
free_irq(i2c->irq, i2c);
fail_request:
irq_dispose_mapping(i2c->irq);
iounmap(i2c->base);
fail_map:
kfree(i2c);
return result;
};
/** Shared device initialization code */
static int __devinit xilinx_iic_setup(
struct device *device,
struct device_node *node,
struct resource *r_mem,
struct resource *r_irq,
u32 ten_bit_addr,
u32 gpo_width) {
XIic_Config xiic_cfg;
struct xiic_data *dev;
char *scan_results;
int error;
/* Allocate the dev and zero it out. */
dev = kmalloc(sizeof(struct xiic_data), GFP_KERNEL);
if (!dev) {
dev_err(device, "Cannot allocate struct xiic_data\n");
error = -ENOMEM;
goto out2;
}
memset(dev, 0, sizeof(struct xiic_data));
dev_set_drvdata(device, dev);
dev->irq = r_irq->start;
/* initialize fields to satisfy i2c */
dev->index = 0;
init_completion(&dev->complete);
memset(&xiic_cfg, 0, sizeof(XIic_Config));
xiic_cfg.DeviceId = 0;
/* Change the addresses to be virtual; save the old ones to restore. */
dev->base = r_mem->start;
xiic_cfg.BaseAddress =
(u32) ioremap(r_mem->start, r_mem->end - r_mem->start + 1);
dev->remapped = 1;
down(&cfg_sem);
xiic_cfg.Has10BitAddr = (int)ten_bit_addr;
xiic_cfg.GpOutWidth = (u8)gpo_width;
/* Tell the Xilinx code to bring this IIC interface up. */
if (XIic_CfgInitialize(&dev->Iic, &xiic_cfg, xiic_cfg.BaseAddress) !=
XST_SUCCESS) {
up(&cfg_sem);
dev_err(device, "could not initialize device.\n");
error = -ENODEV;
goto out;
}
up(&cfg_sem);
XIic_SetRecvHandler(&dev->Iic, (void *)dev, RecvHandler);
XIic_SetSendHandler(&dev->Iic, (void *)dev, SendHandler);
XIic_SetStatusHandler(&dev->Iic, (void *)dev, StatusHandler);
/* Grab the IRQ */
error = request_irq(dev->irq, xiic_interrupt, 0, dev->adap.name, dev);
if (error) {
dev_err(device, "could not allocate interrupt %d.\n", dev->irq);
goto out;
}
dev->reqirq = 1;
if (XIic_Start(&dev->Iic) != XST_SUCCESS) {
dev_err(device, "could not start device\n");
error = -ENODEV;
goto out;
}
dev->started = 1;
/* Now tell the core I2C code about our new device. */
strcpy(dev->adap.name, "xilinx-iic");
dev->adap.dev.of_node = node;
dev->adap.algo = &xiic_algo;
dev->adap.algo_data = NULL;
dev->adap.timeout = XIIC_TIMEOUT;
dev->adap.retries = XIIC_RETRY;
error = i2c_add_adapter(&dev->adap);
if (error) {
dev_err(device, "could not add i2c adapter\n");
goto out;
}
dev->added = 1;
printk("%s #%d at 0x%08X mapped to 0x%08X, irq=%d\n",
dev->adap.name, dev->index,
dev->base, (unsigned int)dev->Iic.BaseAddress, dev->irq);
if (scan) {
scan_results = xilinx_iic_do_scan(dev);
if (scan_results) {
printk(scan_results);
kfree(scan_results);
}
}
of_register_i2c_devices(&dev->adap, node);
error = device_create_file(device, &dev_attr_scan);
out:
if (error)
xilinx_iic_remove(device);
out2:
return error;
}
