11da177e4SLinus Torvalds /* ------------------------------------------------------------------------ * 21da177e4SLinus Torvalds * i2c-parport.c I2C bus over parallel port * 31da177e4SLinus Torvalds * ------------------------------------------------------------------------ * 43af07bd2SJean Delvare Copyright (C) 2003-2007 Jean Delvare <khali@linux-fr.org> 51da177e4SLinus Torvalds 61da177e4SLinus Torvalds Based on older i2c-philips-par.c driver 71da177e4SLinus Torvalds Copyright (C) 1995-2000 Simon G. Vogl 81da177e4SLinus Torvalds With some changes from: 91da177e4SLinus Torvalds Frodo Looijaard <frodol@dds.nl> 101da177e4SLinus Torvalds Ky�sti M�lkki <kmalkki@cc.hut.fi> 111da177e4SLinus Torvalds 121da177e4SLinus Torvalds This program is free software; you can redistribute it and/or modify 131da177e4SLinus Torvalds it under the terms of the GNU General Public License as published by 141da177e4SLinus Torvalds the Free Software Foundation; either version 2 of the License, or 151da177e4SLinus Torvalds (at your option) any later version. 161da177e4SLinus Torvalds 171da177e4SLinus Torvalds This program is distributed in the hope that it will be useful, 181da177e4SLinus Torvalds but WITHOUT ANY WARRANTY; without even the implied warranty of 191da177e4SLinus Torvalds MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 201da177e4SLinus Torvalds GNU General Public License for more details. 211da177e4SLinus Torvalds 221da177e4SLinus Torvalds You should have received a copy of the GNU General Public License 231da177e4SLinus Torvalds along with this program; if not, write to the Free Software 241da177e4SLinus Torvalds Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. 251da177e4SLinus Torvalds * ------------------------------------------------------------------------ */ 261da177e4SLinus Torvalds 271da177e4SLinus Torvalds #include <linux/kernel.h> 281da177e4SLinus Torvalds #include <linux/module.h> 291da177e4SLinus Torvalds #include <linux/init.h> 301da177e4SLinus Torvalds #include <linux/parport.h> 311da177e4SLinus Torvalds #include <linux/i2c.h> 321da177e4SLinus Torvalds #include <linux/i2c-algo-bit.h> 331da177e4SLinus Torvalds #include "i2c-parport.h" 341da177e4SLinus Torvalds 351da177e4SLinus Torvalds /* ----- Device list ------------------------------------------------------ */ 361da177e4SLinus Torvalds 371da177e4SLinus Torvalds struct i2c_par { 381da177e4SLinus Torvalds struct pardevice *pdev; 391da177e4SLinus Torvalds struct i2c_adapter adapter; 401da177e4SLinus Torvalds struct i2c_algo_bit_data algo_data; 411da177e4SLinus Torvalds struct i2c_par *next; 421da177e4SLinus Torvalds }; 431da177e4SLinus Torvalds 441da177e4SLinus Torvalds static struct i2c_par *adapter_list; 451da177e4SLinus Torvalds 461da177e4SLinus Torvalds /* ----- Low-level parallel port access ----------------------------------- */ 471da177e4SLinus Torvalds 481da177e4SLinus Torvalds static void port_write_data(struct parport *p, unsigned char d) 491da177e4SLinus Torvalds { 501da177e4SLinus Torvalds parport_write_data(p, d); 511da177e4SLinus Torvalds } 521da177e4SLinus Torvalds 531da177e4SLinus Torvalds static void port_write_control(struct parport *p, unsigned char d) 541da177e4SLinus Torvalds { 551da177e4SLinus Torvalds parport_write_control(p, d); 561da177e4SLinus Torvalds } 571da177e4SLinus Torvalds 581da177e4SLinus Torvalds static unsigned char port_read_data(struct parport *p) 591da177e4SLinus Torvalds { 601da177e4SLinus Torvalds return parport_read_data(p); 611da177e4SLinus Torvalds } 621da177e4SLinus Torvalds 631da177e4SLinus Torvalds static unsigned char port_read_status(struct parport *p) 641da177e4SLinus Torvalds { 651da177e4SLinus Torvalds return parport_read_status(p); 661da177e4SLinus Torvalds } 671da177e4SLinus Torvalds 681da177e4SLinus Torvalds static unsigned char port_read_control(struct parport *p) 691da177e4SLinus Torvalds { 701da177e4SLinus Torvalds return parport_read_control(p); 711da177e4SLinus Torvalds } 721da177e4SLinus Torvalds 731da177e4SLinus Torvalds static void (*port_write[])(struct parport *, unsigned char) = { 741da177e4SLinus Torvalds port_write_data, 751da177e4SLinus Torvalds NULL, 761da177e4SLinus Torvalds port_write_control, 771da177e4SLinus Torvalds }; 781da177e4SLinus Torvalds 791da177e4SLinus Torvalds static unsigned char (*port_read[])(struct parport *) = { 801da177e4SLinus Torvalds port_read_data, 811da177e4SLinus Torvalds port_read_status, 821da177e4SLinus Torvalds port_read_control, 831da177e4SLinus Torvalds }; 841da177e4SLinus Torvalds 851da177e4SLinus Torvalds /* ----- Unified line operation functions --------------------------------- */ 861da177e4SLinus Torvalds 871da177e4SLinus Torvalds static inline void line_set(struct parport *data, int state, 881da177e4SLinus Torvalds const struct lineop *op) 891da177e4SLinus Torvalds { 901da177e4SLinus Torvalds u8 oldval = port_read[op->port](data); 911da177e4SLinus Torvalds 921da177e4SLinus Torvalds /* Touch only the bit(s) needed */ 931da177e4SLinus Torvalds if ((op->inverted && !state) || (!op->inverted && state)) 941da177e4SLinus Torvalds port_write[op->port](data, oldval | op->val); 951da177e4SLinus Torvalds else 961da177e4SLinus Torvalds port_write[op->port](data, oldval & ~op->val); 971da177e4SLinus Torvalds } 981da177e4SLinus Torvalds 991da177e4SLinus Torvalds static inline int line_get(struct parport *data, 1001da177e4SLinus Torvalds const struct lineop *op) 1011da177e4SLinus Torvalds { 1021da177e4SLinus Torvalds u8 oldval = port_read[op->port](data); 1031da177e4SLinus Torvalds 1041da177e4SLinus Torvalds return ((op->inverted && (oldval & op->val) != op->val) 1051da177e4SLinus Torvalds || (!op->inverted && (oldval & op->val) == op->val)); 1061da177e4SLinus Torvalds } 1071da177e4SLinus Torvalds 1081da177e4SLinus Torvalds /* ----- I2C algorithm call-back functions and structures ----------------- */ 1091da177e4SLinus Torvalds 1101da177e4SLinus Torvalds static void parport_setscl(void *data, int state) 1111da177e4SLinus Torvalds { 1121da177e4SLinus Torvalds line_set((struct parport *) data, state, &adapter_parm[type].setscl); 1131da177e4SLinus Torvalds } 1141da177e4SLinus Torvalds 1151da177e4SLinus Torvalds static void parport_setsda(void *data, int state) 1161da177e4SLinus Torvalds { 1171da177e4SLinus Torvalds line_set((struct parport *) data, state, &adapter_parm[type].setsda); 1181da177e4SLinus Torvalds } 1191da177e4SLinus Torvalds 1201da177e4SLinus Torvalds static int parport_getscl(void *data) 1211da177e4SLinus Torvalds { 1221da177e4SLinus Torvalds return line_get((struct parport *) data, &adapter_parm[type].getscl); 1231da177e4SLinus Torvalds } 1241da177e4SLinus Torvalds 1251da177e4SLinus Torvalds static int parport_getsda(void *data) 1261da177e4SLinus Torvalds { 1271da177e4SLinus Torvalds return line_get((struct parport *) data, &adapter_parm[type].getsda); 1281da177e4SLinus Torvalds } 1291da177e4SLinus Torvalds 1301da177e4SLinus Torvalds /* Encapsulate the functions above in the correct structure. 1311da177e4SLinus Torvalds Note that this is only a template, from which the real structures are 1321da177e4SLinus Torvalds copied. The attaching code will set getscl to NULL for adapters that 133614e24beSTobias Klauser cannot read SCL back, and will also make the data field point to 1341da177e4SLinus Torvalds the parallel port structure. */ 1351da177e4SLinus Torvalds static struct i2c_algo_bit_data parport_algo_data = { 1361da177e4SLinus Torvalds .setsda = parport_setsda, 1371da177e4SLinus Torvalds .setscl = parport_setscl, 1381da177e4SLinus Torvalds .getsda = parport_getsda, 1391da177e4SLinus Torvalds .getscl = parport_getscl, 1403af07bd2SJean Delvare .udelay = 10, /* ~50 kbps */ 1411da177e4SLinus Torvalds .timeout = HZ, 1421da177e4SLinus Torvalds }; 1431da177e4SLinus Torvalds 1441da177e4SLinus Torvalds /* ----- I2c and parallel port call-back functions and structures --------- */ 1451da177e4SLinus Torvalds 1461da177e4SLinus Torvalds static void i2c_parport_attach (struct parport *port) 1471da177e4SLinus Torvalds { 1481da177e4SLinus Torvalds struct i2c_par *adapter; 1491da177e4SLinus Torvalds 1505263ebb5SDeepak Saxena adapter = kzalloc(sizeof(struct i2c_par), GFP_KERNEL); 1511da177e4SLinus Torvalds if (adapter == NULL) { 1525263ebb5SDeepak Saxena printk(KERN_ERR "i2c-parport: Failed to kzalloc\n"); 1531da177e4SLinus Torvalds return; 1541da177e4SLinus Torvalds } 1551da177e4SLinus Torvalds 1561da177e4SLinus Torvalds pr_debug("i2c-parport: attaching to %s\n", port->name); 1571da177e4SLinus Torvalds adapter->pdev = parport_register_device(port, "i2c-parport", 1581da177e4SLinus Torvalds NULL, NULL, NULL, PARPORT_FLAG_EXCL, NULL); 1591da177e4SLinus Torvalds if (!adapter->pdev) { 1601da177e4SLinus Torvalds printk(KERN_ERR "i2c-parport: Unable to register with parport\n"); 1611da177e4SLinus Torvalds goto ERROR0; 1621da177e4SLinus Torvalds } 1631da177e4SLinus Torvalds 1641da177e4SLinus Torvalds /* Fill the rest of the structure */ 165cacf2269SJean Delvare adapter->adapter.owner = THIS_MODULE; 166cacf2269SJean Delvare adapter->adapter.class = I2C_CLASS_HWMON; 167cacf2269SJean Delvare adapter->adapter.id = I2C_HW_B_LP; 168cacf2269SJean Delvare strlcpy(adapter->adapter.name, "Parallel port adapter", 169cacf2269SJean Delvare sizeof(adapter->adapter.name)); 1701da177e4SLinus Torvalds adapter->algo_data = parport_algo_data; 1713af07bd2SJean Delvare /* Slow down if we can't sense SCL */ 1723af07bd2SJean Delvare if (!adapter_parm[type].getscl.val) { 1731da177e4SLinus Torvalds adapter->algo_data.getscl = NULL; 1743af07bd2SJean Delvare adapter->algo_data.udelay = 50; /* ~10 kbps */ 1753af07bd2SJean Delvare } 1761da177e4SLinus Torvalds adapter->algo_data.data = port; 1771da177e4SLinus Torvalds adapter->adapter.algo_data = &adapter->algo_data; 178da675296SDavid Brownell adapter->adapter.dev.parent = port->physport->dev; 1791da177e4SLinus Torvalds 1801da177e4SLinus Torvalds if (parport_claim_or_block(adapter->pdev) < 0) { 1811da177e4SLinus Torvalds printk(KERN_ERR "i2c-parport: Could not claim parallel port\n"); 1821da177e4SLinus Torvalds goto ERROR1; 1831da177e4SLinus Torvalds } 1841da177e4SLinus Torvalds 1851da177e4SLinus Torvalds /* Reset hardware to a sane state (SCL and SDA high) */ 1861da177e4SLinus Torvalds parport_setsda(port, 1); 1871da177e4SLinus Torvalds parport_setscl(port, 1); 1881da177e4SLinus Torvalds /* Other init if needed (power on...) */ 1891da177e4SLinus Torvalds if (adapter_parm[type].init.val) 1901da177e4SLinus Torvalds line_set(port, 1, &adapter_parm[type].init); 1911da177e4SLinus Torvalds 1921da177e4SLinus Torvalds parport_release(adapter->pdev); 1931da177e4SLinus Torvalds 1941da177e4SLinus Torvalds if (i2c_bit_add_bus(&adapter->adapter) < 0) { 1951da177e4SLinus Torvalds printk(KERN_ERR "i2c-parport: Unable to register with I2C\n"); 1961da177e4SLinus Torvalds goto ERROR1; 1971da177e4SLinus Torvalds } 1981da177e4SLinus Torvalds 1991da177e4SLinus Torvalds /* Add the new adapter to the list */ 2001da177e4SLinus Torvalds adapter->next = adapter_list; 2011da177e4SLinus Torvalds adapter_list = adapter; 2021da177e4SLinus Torvalds return; 2031da177e4SLinus Torvalds 2041da177e4SLinus Torvalds ERROR1: 2051da177e4SLinus Torvalds parport_unregister_device(adapter->pdev); 2061da177e4SLinus Torvalds ERROR0: 2071da177e4SLinus Torvalds kfree(adapter); 2081da177e4SLinus Torvalds } 2091da177e4SLinus Torvalds 2101da177e4SLinus Torvalds static void i2c_parport_detach (struct parport *port) 2111da177e4SLinus Torvalds { 2121da177e4SLinus Torvalds struct i2c_par *adapter, *prev; 2131da177e4SLinus Torvalds 2141da177e4SLinus Torvalds /* Walk the list */ 2151da177e4SLinus Torvalds for (prev = NULL, adapter = adapter_list; adapter; 2161da177e4SLinus Torvalds prev = adapter, adapter = adapter->next) { 2171da177e4SLinus Torvalds if (adapter->pdev->port == port) { 2183af07bd2SJean Delvare i2c_del_adapter(&adapter->adapter); 2193af07bd2SJean Delvare 2201da177e4SLinus Torvalds /* Un-init if needed (power off...) */ 2211da177e4SLinus Torvalds if (adapter_parm[type].init.val) 2221da177e4SLinus Torvalds line_set(port, 0, &adapter_parm[type].init); 2231da177e4SLinus Torvalds 2241da177e4SLinus Torvalds parport_unregister_device(adapter->pdev); 2251da177e4SLinus Torvalds if (prev) 2261da177e4SLinus Torvalds prev->next = adapter->next; 2271da177e4SLinus Torvalds else 2281da177e4SLinus Torvalds adapter_list = adapter->next; 2291da177e4SLinus Torvalds kfree(adapter); 2301da177e4SLinus Torvalds return; 2311da177e4SLinus Torvalds } 2321da177e4SLinus Torvalds } 2331da177e4SLinus Torvalds } 2341da177e4SLinus Torvalds 2356c129be8SJean Delvare static struct parport_driver i2c_parport_driver = { 2361da177e4SLinus Torvalds .name = "i2c-parport", 2371da177e4SLinus Torvalds .attach = i2c_parport_attach, 2381da177e4SLinus Torvalds .detach = i2c_parport_detach, 2391da177e4SLinus Torvalds }; 2401da177e4SLinus Torvalds 2411da177e4SLinus Torvalds /* ----- Module loading, unloading and information ------------------------ */ 2421da177e4SLinus Torvalds 2431da177e4SLinus Torvalds static int __init i2c_parport_init(void) 2441da177e4SLinus Torvalds { 245e97b81ddSMark M. Hoffman if (type < 0) { 246e97b81ddSMark M. Hoffman printk(KERN_WARNING "i2c-parport: adapter type unspecified\n"); 247e97b81ddSMark M. Hoffman return -ENODEV; 248e97b81ddSMark M. Hoffman } 249e97b81ddSMark M. Hoffman 250e97b81ddSMark M. Hoffman if (type >= ARRAY_SIZE(adapter_parm)) { 2511da177e4SLinus Torvalds printk(KERN_WARNING "i2c-parport: invalid type (%d)\n", type); 252e97b81ddSMark M. Hoffman return -ENODEV; 2531da177e4SLinus Torvalds } 2541da177e4SLinus Torvalds 2556c129be8SJean Delvare return parport_register_driver(&i2c_parport_driver); 2561da177e4SLinus Torvalds } 2571da177e4SLinus Torvalds 2581da177e4SLinus Torvalds static void __exit i2c_parport_exit(void) 2591da177e4SLinus Torvalds { 2606c129be8SJean Delvare parport_unregister_driver(&i2c_parport_driver); 2611da177e4SLinus Torvalds } 2621da177e4SLinus Torvalds 2631da177e4SLinus Torvalds MODULE_AUTHOR("Jean Delvare <khali@linux-fr.org>"); 2641da177e4SLinus Torvalds MODULE_DESCRIPTION("I2C bus over parallel port"); 2651da177e4SLinus Torvalds MODULE_LICENSE("GPL"); 2661da177e4SLinus Torvalds 2671da177e4SLinus Torvalds module_init(i2c_parport_init); 2681da177e4SLinus Torvalds module_exit(i2c_parport_exit); 269