16b65cd74SRussell King /* 26b65cd74SRussell King * i2c-versatile.c 36b65cd74SRussell King * 46b65cd74SRussell King * Copyright (C) 2006 ARM Ltd. 56b65cd74SRussell King * written by Russell King, Deep Blue Solutions Ltd. 66b65cd74SRussell King * 76b65cd74SRussell King * This program is free software; you can redistribute it and/or modify 86b65cd74SRussell King * it under the terms of the GNU General Public License version 2 as 96b65cd74SRussell King * published by the Free Software Foundation. 106b65cd74SRussell King */ 116b65cd74SRussell King #include <linux/kernel.h> 126b65cd74SRussell King #include <linux/module.h> 136b65cd74SRussell King #include <linux/i2c.h> 146b65cd74SRussell King #include <linux/i2c-algo-bit.h> 156b65cd74SRussell King #include <linux/init.h> 166b65cd74SRussell King #include <linux/platform_device.h> 175a0e3ad6STejun Heo #include <linux/slab.h> 1821782180SH Hartley Sweeten #include <linux/io.h> 196b65cd74SRussell King 206b65cd74SRussell King #define I2C_CONTROL 0x00 216b65cd74SRussell King #define I2C_CONTROLS 0x00 226b65cd74SRussell King #define I2C_CONTROLC 0x04 236b65cd74SRussell King #define SCL (1 << 0) 246b65cd74SRussell King #define SDA (1 << 1) 256b65cd74SRussell King 266b65cd74SRussell King struct i2c_versatile { 276b65cd74SRussell King struct i2c_adapter adap; 286b65cd74SRussell King struct i2c_algo_bit_data algo; 296b65cd74SRussell King void __iomem *base; 306b65cd74SRussell King }; 316b65cd74SRussell King 326b65cd74SRussell King static void i2c_versatile_setsda(void *data, int state) 336b65cd74SRussell King { 346b65cd74SRussell King struct i2c_versatile *i2c = data; 356b65cd74SRussell King 366b65cd74SRussell King writel(SDA, i2c->base + (state ? I2C_CONTROLS : I2C_CONTROLC)); 376b65cd74SRussell King } 386b65cd74SRussell King 396b65cd74SRussell King static void i2c_versatile_setscl(void *data, int state) 406b65cd74SRussell King { 416b65cd74SRussell King struct i2c_versatile *i2c = data; 426b65cd74SRussell King 436b65cd74SRussell King writel(SCL, i2c->base + (state ? I2C_CONTROLS : I2C_CONTROLC)); 446b65cd74SRussell King } 456b65cd74SRussell King 466b65cd74SRussell King static int i2c_versatile_getsda(void *data) 476b65cd74SRussell King { 486b65cd74SRussell King struct i2c_versatile *i2c = data; 496b65cd74SRussell King return !!(readl(i2c->base + I2C_CONTROL) & SDA); 506b65cd74SRussell King } 516b65cd74SRussell King 526b65cd74SRussell King static int i2c_versatile_getscl(void *data) 536b65cd74SRussell King { 546b65cd74SRussell King struct i2c_versatile *i2c = data; 556b65cd74SRussell King return !!(readl(i2c->base + I2C_CONTROL) & SCL); 566b65cd74SRussell King } 576b65cd74SRussell King 58a89c22d5SBhumika Goyal static const struct i2c_algo_bit_data i2c_versatile_algo = { 596b65cd74SRussell King .setsda = i2c_versatile_setsda, 606b65cd74SRussell King .setscl = i2c_versatile_setscl, 616b65cd74SRussell King .getsda = i2c_versatile_getsda, 626b65cd74SRussell King .getscl = i2c_versatile_getscl, 636b65cd74SRussell King .udelay = 30, 646b65cd74SRussell King .timeout = HZ, 656b65cd74SRussell King }; 666b65cd74SRussell King 676b65cd74SRussell King static int i2c_versatile_probe(struct platform_device *dev) 686b65cd74SRussell King { 696b65cd74SRussell King struct i2c_versatile *i2c; 706b65cd74SRussell King struct resource *r; 716b65cd74SRussell King int ret; 726b65cd74SRussell King 73cc461881SAxel Lin i2c = devm_kzalloc(&dev->dev, sizeof(struct i2c_versatile), GFP_KERNEL); 74cc461881SAxel Lin if (!i2c) 75cc461881SAxel Lin return -ENOMEM; 76cc461881SAxel Lin 776b65cd74SRussell King r = platform_get_resource(dev, IORESOURCE_MEM, 0); 78cc461881SAxel Lin i2c->base = devm_ioremap_resource(&dev->dev, r); 79cc461881SAxel Lin if (IS_ERR(i2c->base)) 80cc461881SAxel Lin return PTR_ERR(i2c->base); 816b65cd74SRussell King 826b65cd74SRussell King writel(SCL | SDA, i2c->base + I2C_CONTROLS); 836b65cd74SRussell King 846b65cd74SRussell King i2c->adap.owner = THIS_MODULE; 856b65cd74SRussell King strlcpy(i2c->adap.name, "Versatile I2C adapter", sizeof(i2c->adap.name)); 866b65cd74SRussell King i2c->adap.algo_data = &i2c->algo; 876b65cd74SRussell King i2c->adap.dev.parent = &dev->dev; 88237ab406SPawel Moll i2c->adap.dev.of_node = dev->dev.of_node; 896b65cd74SRussell King i2c->algo = i2c_versatile_algo; 906b65cd74SRussell King i2c->algo.data = i2c; 916b65cd74SRussell King 922514cca0SCatalin Marinas i2c->adap.nr = dev->id; 932514cca0SCatalin Marinas ret = i2c_bit_add_numbered_bus(&i2c->adap); 94cc461881SAxel Lin if (ret < 0) 956b65cd74SRussell King return ret; 96cc461881SAxel Lin 97cc461881SAxel Lin platform_set_drvdata(dev, i2c); 98cc461881SAxel Lin 99cc461881SAxel Lin return 0; 1006b65cd74SRussell King } 1016b65cd74SRussell King 1026b65cd74SRussell King static int i2c_versatile_remove(struct platform_device *dev) 1036b65cd74SRussell King { 1046b65cd74SRussell King struct i2c_versatile *i2c = platform_get_drvdata(dev); 1056b65cd74SRussell King 1066b65cd74SRussell King i2c_del_adapter(&i2c->adap); 1076b65cd74SRussell King return 0; 1086b65cd74SRussell King } 1096b65cd74SRussell King 110237ab406SPawel Moll static const struct of_device_id i2c_versatile_match[] = { 111237ab406SPawel Moll { .compatible = "arm,versatile-i2c", }, 112237ab406SPawel Moll {}, 113237ab406SPawel Moll }; 114237ab406SPawel Moll MODULE_DEVICE_TABLE(of, i2c_versatile_match); 115237ab406SPawel Moll 1166b65cd74SRussell King static struct platform_driver i2c_versatile_driver = { 1176b65cd74SRussell King .probe = i2c_versatile_probe, 1186b65cd74SRussell King .remove = i2c_versatile_remove, 1196b65cd74SRussell King .driver = { 1206b65cd74SRussell King .name = "versatile-i2c", 121237ab406SPawel Moll .of_match_table = i2c_versatile_match, 1226b65cd74SRussell King }, 1236b65cd74SRussell King }; 1246b65cd74SRussell King 1256b65cd74SRussell King static int __init i2c_versatile_init(void) 1266b65cd74SRussell King { 1276b65cd74SRussell King return platform_driver_register(&i2c_versatile_driver); 1286b65cd74SRussell King } 1296b65cd74SRussell King 1306b65cd74SRussell King static void __exit i2c_versatile_exit(void) 1316b65cd74SRussell King { 1326b65cd74SRussell King platform_driver_unregister(&i2c_versatile_driver); 1336b65cd74SRussell King } 1346b65cd74SRussell King 1352514cca0SCatalin Marinas subsys_initcall(i2c_versatile_init); 1366b65cd74SRussell King module_exit(i2c_versatile_exit); 1376b65cd74SRussell King 1386b65cd74SRussell King MODULE_DESCRIPTION("ARM Versatile I2C bus driver"); 1396b65cd74SRussell King MODULE_LICENSE("GPL"); 140add8eda7SKay Sievers MODULE_ALIAS("platform:versatile-i2c"); 141