static int fsl_i2c_probe(struct platform_device *pdev) { int result = 0; struct mpc_i2c *i2c; struct fsl_i2c_platform_data *pdata; struct resource *r = platform_get_resource(pdev, IORESOURCE_MEM, 0); pdata = (struct fsl_i2c_platform_data *) pdev->dev.platform_data; if (!(i2c = kzalloc(sizeof(*i2c), GFP_KERNEL))) { return -ENOMEM; } i2c->irq = platform_get_irq(pdev, 0); if (i2c->irq < 0) { result = -ENXIO; goto fail_get_irq; } i2c->flags = pdata->device_flags; init_waitqueue_head(&i2c->queue); i2c->base = ioremap((phys_addr_t)r->start, MPC_I2C_REGION); if (!i2c->base) { printk(KERN_ERR "i2c-mpc - failed to map controller\n"); result = -ENOMEM; goto fail_map; } if (i2c->irq != 0) if ((result = request_irq(i2c->irq, mpc_i2c_isr, SA_SHIRQ, "i2c-mpc", i2c)) < 0) { printk(KERN_ERR "i2c-mpc - failed to attach interrupt\n"); goto fail_irq; } mpc_i2c_setclock(i2c); platform_set_drvdata(pdev, i2c); i2c->adap = mpc_ops; i2c_set_adapdata(&i2c->adap, i2c); i2c->adap.dev.parent = &pdev->dev; if ((result = i2c_add_adapter(&i2c->adap)) < 0) { printk(KERN_ERR "i2c-mpc - failed to add adapter\n"); goto fail_add; } return result; fail_add: if (i2c->irq != 0) free_irq(i2c->irq, NULL); fail_irq: iounmap(i2c->base); fail_map: fail_get_irq: kfree(i2c); return result; };
static int __devinit mpc_i2c_probe(struct ocp_device *ocp) { int result = 0; struct mpc_i2c *i2c; if (!(i2c = kmalloc(sizeof(*i2c), GFP_KERNEL))) { return -ENOMEM; } memset(i2c, 0, sizeof(*i2c)); i2c->irq = ocp->def->irq; i2c->flags = ((struct ocp_fs_i2c_data *)ocp->def->additions)->flags; init_waitqueue_head(&i2c->queue); if (!request_mem_region(ocp->def->paddr, MPC_I2C_REGION, "i2c-mpc")) { printk(KERN_ERR "i2c-mpc - resource unavailable\n"); return -ENODEV; } i2c->base = ioremap(ocp->def->paddr, MPC_I2C_REGION); if (!i2c->base) { printk(KERN_ERR "i2c-mpc - failed to map controller\n"); result = -ENOMEM; goto fail_map; } if (i2c->irq != OCP_IRQ_NA) { if ((result = request_irq(ocp->def->irq, mpc_i2c_isr, 0, "i2c-mpc", i2c)) < 0) { printk(KERN_ERR "i2c-mpc - failed to attach interrupt\n"); goto fail_irq; } } else i2c->irq = 0; i2c->adap = mpc_ops; i2c_set_adapdata(&i2c->adap, i2c); if ((result = i2c_add_adapter(&i2c->adap)) < 0) { printk(KERN_ERR "i2c-mpc - failed to add adapter\n"); goto fail_add; } mpc_i2c_setclock(i2c); ocp_set_drvdata(ocp, i2c); return result; fail_add: if (ocp->def->irq != OCP_IRQ_NA) free_irq(ocp->def->irq, 0); fail_irq: iounmap(i2c->base); fail_map: release_mem_region(ocp->def->paddr, MPC_I2C_REGION); kfree(i2c); return result; }
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; };