17e94dd15SSebastian Andrzej Siewior /* 27e94dd15SSebastian Andrzej Siewior * The CE4100's I2C device is more or less the same one as found on PXA. 37e94dd15SSebastian Andrzej Siewior * It does not support slave mode, the register slightly moved. This PCI 47e94dd15SSebastian Andrzej Siewior * device provides three bars, every contains a single I2C controller. 57e94dd15SSebastian Andrzej Siewior */ 67e94dd15SSebastian Andrzej Siewior #include <linux/pci.h> 77e94dd15SSebastian Andrzej Siewior #include <linux/platform_device.h> 87e94dd15SSebastian Andrzej Siewior #include <linux/i2c/pxa-i2c.h> 97e94dd15SSebastian Andrzej Siewior #include <linux/of.h> 107e94dd15SSebastian Andrzej Siewior #include <linux/of_device.h> 117e94dd15SSebastian Andrzej Siewior #include <linux/of_address.h> 127e94dd15SSebastian Andrzej Siewior 137e94dd15SSebastian Andrzej Siewior #define CE4100_PCI_I2C_DEVS 3 147e94dd15SSebastian Andrzej Siewior 157e94dd15SSebastian Andrzej Siewior struct ce4100_devices { 167e94dd15SSebastian Andrzej Siewior struct platform_device *pdev[CE4100_PCI_I2C_DEVS]; 177e94dd15SSebastian Andrzej Siewior }; 187e94dd15SSebastian Andrzej Siewior 197e94dd15SSebastian Andrzej Siewior static struct platform_device *add_i2c_device(struct pci_dev *dev, int bar) 207e94dd15SSebastian Andrzej Siewior { 217e94dd15SSebastian Andrzej Siewior struct platform_device *pdev; 227e94dd15SSebastian Andrzej Siewior struct i2c_pxa_platform_data pdata; 237e94dd15SSebastian Andrzej Siewior struct resource res[2]; 247e94dd15SSebastian Andrzej Siewior struct device_node *child; 257e94dd15SSebastian Andrzej Siewior static int devnum; 267e94dd15SSebastian Andrzej Siewior int ret; 277e94dd15SSebastian Andrzej Siewior 287e94dd15SSebastian Andrzej Siewior memset(&pdata, 0, sizeof(struct i2c_pxa_platform_data)); 297e94dd15SSebastian Andrzej Siewior memset(&res, 0, sizeof(res)); 307e94dd15SSebastian Andrzej Siewior 317e94dd15SSebastian Andrzej Siewior res[0].flags = IORESOURCE_MEM; 327e94dd15SSebastian Andrzej Siewior res[0].start = pci_resource_start(dev, bar); 337e94dd15SSebastian Andrzej Siewior res[0].end = pci_resource_end(dev, bar); 347e94dd15SSebastian Andrzej Siewior 357e94dd15SSebastian Andrzej Siewior res[1].flags = IORESOURCE_IRQ; 367e94dd15SSebastian Andrzej Siewior res[1].start = dev->irq; 377e94dd15SSebastian Andrzej Siewior res[1].end = dev->irq; 387e94dd15SSebastian Andrzej Siewior 397e94dd15SSebastian Andrzej Siewior for_each_child_of_node(dev->dev.of_node, child) { 407e94dd15SSebastian Andrzej Siewior const void *prop; 417e94dd15SSebastian Andrzej Siewior struct resource r; 427e94dd15SSebastian Andrzej Siewior int ret; 437e94dd15SSebastian Andrzej Siewior 447e94dd15SSebastian Andrzej Siewior ret = of_address_to_resource(child, 0, &r); 457e94dd15SSebastian Andrzej Siewior if (ret < 0) 467e94dd15SSebastian Andrzej Siewior continue; 477e94dd15SSebastian Andrzej Siewior if (r.start != res[0].start) 487e94dd15SSebastian Andrzej Siewior continue; 497e94dd15SSebastian Andrzej Siewior if (r.end != res[0].end) 507e94dd15SSebastian Andrzej Siewior continue; 517e94dd15SSebastian Andrzej Siewior if (r.flags != res[0].flags) 527e94dd15SSebastian Andrzej Siewior continue; 537e94dd15SSebastian Andrzej Siewior 547e94dd15SSebastian Andrzej Siewior prop = of_get_property(child, "fast-mode", NULL); 557e94dd15SSebastian Andrzej Siewior if (prop) 567e94dd15SSebastian Andrzej Siewior pdata.fast_mode = 1; 577e94dd15SSebastian Andrzej Siewior 587e94dd15SSebastian Andrzej Siewior break; 597e94dd15SSebastian Andrzej Siewior } 607e94dd15SSebastian Andrzej Siewior 617e94dd15SSebastian Andrzej Siewior if (!child) { 627e94dd15SSebastian Andrzej Siewior dev_err(&dev->dev, "failed to match a DT node for bar %d.\n", 637e94dd15SSebastian Andrzej Siewior bar); 647e94dd15SSebastian Andrzej Siewior ret = -EINVAL; 657e94dd15SSebastian Andrzej Siewior goto out; 667e94dd15SSebastian Andrzej Siewior } 677e94dd15SSebastian Andrzej Siewior 687e94dd15SSebastian Andrzej Siewior pdev = platform_device_alloc("ce4100-i2c", devnum); 697e94dd15SSebastian Andrzej Siewior if (!pdev) { 707e94dd15SSebastian Andrzej Siewior of_node_put(child); 717e94dd15SSebastian Andrzej Siewior ret = -ENOMEM; 727e94dd15SSebastian Andrzej Siewior goto out; 737e94dd15SSebastian Andrzej Siewior } 747e94dd15SSebastian Andrzej Siewior pdev->dev.parent = &dev->dev; 757e94dd15SSebastian Andrzej Siewior pdev->dev.of_node = child; 767e94dd15SSebastian Andrzej Siewior 777e94dd15SSebastian Andrzej Siewior ret = platform_device_add_resources(pdev, res, ARRAY_SIZE(res)); 787e94dd15SSebastian Andrzej Siewior if (ret) 797e94dd15SSebastian Andrzej Siewior goto err; 807e94dd15SSebastian Andrzej Siewior 817e94dd15SSebastian Andrzej Siewior ret = platform_device_add_data(pdev, &pdata, sizeof(pdata)); 827e94dd15SSebastian Andrzej Siewior if (ret) 837e94dd15SSebastian Andrzej Siewior goto err; 847e94dd15SSebastian Andrzej Siewior 857e94dd15SSebastian Andrzej Siewior ret = platform_device_add(pdev); 867e94dd15SSebastian Andrzej Siewior if (ret) 877e94dd15SSebastian Andrzej Siewior goto err; 887e94dd15SSebastian Andrzej Siewior devnum++; 897e94dd15SSebastian Andrzej Siewior return pdev; 907e94dd15SSebastian Andrzej Siewior err: 917e94dd15SSebastian Andrzej Siewior platform_device_put(pdev); 927e94dd15SSebastian Andrzej Siewior out: 937e94dd15SSebastian Andrzej Siewior return ERR_PTR(ret); 947e94dd15SSebastian Andrzej Siewior } 957e94dd15SSebastian Andrzej Siewior 967e94dd15SSebastian Andrzej Siewior static int __devinit ce4100_i2c_probe(struct pci_dev *dev, 977e94dd15SSebastian Andrzej Siewior const struct pci_device_id *ent) 987e94dd15SSebastian Andrzej Siewior { 997e94dd15SSebastian Andrzej Siewior int ret; 1007e94dd15SSebastian Andrzej Siewior int i; 1017e94dd15SSebastian Andrzej Siewior struct ce4100_devices *sds; 1027e94dd15SSebastian Andrzej Siewior 1037e94dd15SSebastian Andrzej Siewior ret = pci_enable_device_mem(dev); 1047e94dd15SSebastian Andrzej Siewior if (ret) 1057e94dd15SSebastian Andrzej Siewior return ret; 1067e94dd15SSebastian Andrzej Siewior 1077e94dd15SSebastian Andrzej Siewior if (!dev->dev.of_node) { 1087e94dd15SSebastian Andrzej Siewior dev_err(&dev->dev, "Missing device tree node.\n"); 1097e94dd15SSebastian Andrzej Siewior return -EINVAL; 1107e94dd15SSebastian Andrzej Siewior } 1117e94dd15SSebastian Andrzej Siewior sds = kzalloc(sizeof(*sds), GFP_KERNEL); 1127a703adeSAxel Lin if (!sds) { 1137a703adeSAxel Lin ret = -ENOMEM; 1147e94dd15SSebastian Andrzej Siewior goto err_mem; 1157a703adeSAxel Lin } 1167e94dd15SSebastian Andrzej Siewior 1177e94dd15SSebastian Andrzej Siewior for (i = 0; i < ARRAY_SIZE(sds->pdev); i++) { 1187e94dd15SSebastian Andrzej Siewior sds->pdev[i] = add_i2c_device(dev, i); 1197e94dd15SSebastian Andrzej Siewior if (IS_ERR(sds->pdev[i])) { 1207a703adeSAxel Lin ret = PTR_ERR(sds->pdev[i]); 1217e94dd15SSebastian Andrzej Siewior while (--i >= 0) 1227e94dd15SSebastian Andrzej Siewior platform_device_unregister(sds->pdev[i]); 1237e94dd15SSebastian Andrzej Siewior goto err_dev_add; 1247e94dd15SSebastian Andrzej Siewior } 1257e94dd15SSebastian Andrzej Siewior } 1267e94dd15SSebastian Andrzej Siewior pci_set_drvdata(dev, sds); 1277e94dd15SSebastian Andrzej Siewior return 0; 1287e94dd15SSebastian Andrzej Siewior 1297e94dd15SSebastian Andrzej Siewior err_dev_add: 1307e94dd15SSebastian Andrzej Siewior pci_set_drvdata(dev, NULL); 1317e94dd15SSebastian Andrzej Siewior kfree(sds); 1327e94dd15SSebastian Andrzej Siewior err_mem: 1337e94dd15SSebastian Andrzej Siewior pci_disable_device(dev); 1347e94dd15SSebastian Andrzej Siewior return ret; 1357e94dd15SSebastian Andrzej Siewior } 1367e94dd15SSebastian Andrzej Siewior 1377e94dd15SSebastian Andrzej Siewior static void __devexit ce4100_i2c_remove(struct pci_dev *dev) 1387e94dd15SSebastian Andrzej Siewior { 1397e94dd15SSebastian Andrzej Siewior struct ce4100_devices *sds; 1407e94dd15SSebastian Andrzej Siewior unsigned int i; 1417e94dd15SSebastian Andrzej Siewior 1427e94dd15SSebastian Andrzej Siewior sds = pci_get_drvdata(dev); 1437e94dd15SSebastian Andrzej Siewior pci_set_drvdata(dev, NULL); 1447e94dd15SSebastian Andrzej Siewior 1457e94dd15SSebastian Andrzej Siewior for (i = 0; i < ARRAY_SIZE(sds->pdev); i++) 1467e94dd15SSebastian Andrzej Siewior platform_device_unregister(sds->pdev[i]); 1477e94dd15SSebastian Andrzej Siewior 1487e94dd15SSebastian Andrzej Siewior pci_disable_device(dev); 1497e94dd15SSebastian Andrzej Siewior kfree(sds); 1507e94dd15SSebastian Andrzej Siewior } 1517e94dd15SSebastian Andrzej Siewior 1527e94dd15SSebastian Andrzej Siewior static struct pci_device_id ce4100_i2c_devices[] __devinitdata = { 1537e94dd15SSebastian Andrzej Siewior { PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0x2e68)}, 1547e94dd15SSebastian Andrzej Siewior { }, 1557e94dd15SSebastian Andrzej Siewior }; 1567e94dd15SSebastian Andrzej Siewior MODULE_DEVICE_TABLE(pci, ce4100_i2c_devices); 1577e94dd15SSebastian Andrzej Siewior 1587e94dd15SSebastian Andrzej Siewior static struct pci_driver ce4100_i2c_driver = { 1597e94dd15SSebastian Andrzej Siewior .name = "ce4100_i2c", 1607e94dd15SSebastian Andrzej Siewior .id_table = ce4100_i2c_devices, 1617e94dd15SSebastian Andrzej Siewior .probe = ce4100_i2c_probe, 1627e94dd15SSebastian Andrzej Siewior .remove = __devexit_p(ce4100_i2c_remove), 1637e94dd15SSebastian Andrzej Siewior }; 1647e94dd15SSebastian Andrzej Siewior 1657e94dd15SSebastian Andrzej Siewior static int __init ce4100_i2c_init(void) 1667e94dd15SSebastian Andrzej Siewior { 1677e94dd15SSebastian Andrzej Siewior return pci_register_driver(&ce4100_i2c_driver); 1687e94dd15SSebastian Andrzej Siewior } 1697e94dd15SSebastian Andrzej Siewior module_init(ce4100_i2c_init); 1707e94dd15SSebastian Andrzej Siewior 1717e94dd15SSebastian Andrzej Siewior static void __exit ce4100_i2c_exit(void) 1727e94dd15SSebastian Andrzej Siewior { 1737e94dd15SSebastian Andrzej Siewior pci_unregister_driver(&ce4100_i2c_driver); 1747e94dd15SSebastian Andrzej Siewior } 1757e94dd15SSebastian Andrzej Siewior module_exit(ce4100_i2c_exit); 1767e94dd15SSebastian Andrzej Siewior 1777e94dd15SSebastian Andrzej Siewior MODULE_DESCRIPTION("CE4100 PCI-I2C glue code for PXA's driver"); 1787e94dd15SSebastian Andrzej Siewior MODULE_LICENSE("GPL v2"); 1797e94dd15SSebastian Andrzej Siewior MODULE_AUTHOR("Sebastian Andrzej Siewior <bigeasy@linutronix.de>"); 180