i2c-dev.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765
  1. /*
  2. i2c-dev.c - i2c-bus driver, char device interface
  3. Copyright (C) 1995-97 Simon G. Vogl
  4. Copyright (C) 1998-99 Frodo Looijaard <frodol@dds.nl>
  5. Copyright (C) 2003 Greg Kroah-Hartman <greg@kroah.com>
  6. This program is free software; you can redistribute it and/or modify
  7. it under the terms of the GNU General Public License as published by
  8. the Free Software Foundation; either version 2 of the License, or
  9. (at your option) any later version.
  10. This program is distributed in the hope that it will be useful,
  11. but WITHOUT ANY WARRANTY; without even the implied warranty of
  12. MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  13. GNU General Public License for more details.
  14. */
  15. /* Note that this is a complete rewrite of Simon Vogl's i2c-dev module.
  16. But I have used so much of his original code and ideas that it seems
  17. only fair to recognize him as co-author -- Frodo */
  18. /* The I2C_RDWR ioctl code is written by Kolja Waschk <waschk@telos.de> */
  19. #include <linux/cdev.h>
  20. #include <linux/device.h>
  21. #include <linux/fs.h>
  22. #include <linux/i2c-dev.h>
  23. #include <linux/i2c.h>
  24. #include <linux/init.h>
  25. #include <linux/jiffies.h>
  26. #include <linux/kernel.h>
  27. #include <linux/list.h>
  28. #include <linux/module.h>
  29. #include <linux/notifier.h>
  30. #include <linux/slab.h>
  31. #include <linux/uaccess.h>
  32. #include <linux/compat.h>
  33. /*
  34. * An i2c_dev represents an i2c_adapter ... an I2C or SMBus master, not a
  35. * slave (i2c_client) with which messages will be exchanged. It's coupled
  36. * with a character special file which is accessed by user mode drivers.
  37. *
  38. * The list of i2c_dev structures is parallel to the i2c_adapter lists
  39. * maintained by the driver model, and is updated using bus notifications.
  40. */
  41. struct i2c_dev {
  42. struct list_head list;
  43. struct i2c_adapter *adap;
  44. struct device *dev;
  45. struct cdev cdev;
  46. };
  47. #define I2C_MINORS MINORMASK
  48. static LIST_HEAD(i2c_dev_list);
  49. static DEFINE_SPINLOCK(i2c_dev_list_lock);
  50. static struct i2c_dev *i2c_dev_get_by_minor(unsigned index)
  51. {
  52. struct i2c_dev *i2c_dev;
  53. spin_lock(&i2c_dev_list_lock);
  54. list_for_each_entry(i2c_dev, &i2c_dev_list, list) {
  55. if (i2c_dev->adap->nr == index)
  56. goto found;
  57. }
  58. i2c_dev = NULL;
  59. found:
  60. spin_unlock(&i2c_dev_list_lock);
  61. return i2c_dev;
  62. }
  63. static struct i2c_dev *get_free_i2c_dev(struct i2c_adapter *adap)
  64. {
  65. struct i2c_dev *i2c_dev;
  66. if (adap->nr >= I2C_MINORS) {
  67. printk(KERN_ERR "i2c-dev: Out of device minors (%d)\n",
  68. adap->nr);
  69. return ERR_PTR(-ENODEV);
  70. }
  71. i2c_dev = kzalloc(sizeof(*i2c_dev), GFP_KERNEL);
  72. if (!i2c_dev)
  73. return ERR_PTR(-ENOMEM);
  74. i2c_dev->adap = adap;
  75. spin_lock(&i2c_dev_list_lock);
  76. list_add_tail(&i2c_dev->list, &i2c_dev_list);
  77. spin_unlock(&i2c_dev_list_lock);
  78. return i2c_dev;
  79. }
  80. static void put_i2c_dev(struct i2c_dev *i2c_dev)
  81. {
  82. spin_lock(&i2c_dev_list_lock);
  83. list_del(&i2c_dev->list);
  84. spin_unlock(&i2c_dev_list_lock);
  85. kfree(i2c_dev);
  86. }
  87. static ssize_t name_show(struct device *dev,
  88. struct device_attribute *attr, char *buf)
  89. {
  90. struct i2c_dev *i2c_dev = i2c_dev_get_by_minor(MINOR(dev->devt));
  91. if (!i2c_dev)
  92. return -ENODEV;
  93. return sprintf(buf, "%s\n", i2c_dev->adap->name);
  94. }
  95. static DEVICE_ATTR_RO(name);
  96. static struct attribute *i2c_attrs[] = {
  97. &dev_attr_name.attr,
  98. NULL,
  99. };
  100. ATTRIBUTE_GROUPS(i2c);
  101. /* ------------------------------------------------------------------------- */
  102. /*
  103. * After opening an instance of this character special file, a file
  104. * descriptor starts out associated only with an i2c_adapter (and bus).
  105. *
  106. * Using the I2C_RDWR ioctl(), you can then *immediately* issue i2c_msg
  107. * traffic to any devices on the bus used by that adapter. That's because
  108. * the i2c_msg vectors embed all the addressing information they need, and
  109. * are submitted directly to an i2c_adapter. However, SMBus-only adapters
  110. * don't support that interface.
  111. *
  112. * To use read()/write() system calls on that file descriptor, or to use
  113. * SMBus interfaces (and work with SMBus-only hosts!), you must first issue
  114. * an I2C_SLAVE (or I2C_SLAVE_FORCE) ioctl. That configures an anonymous
  115. * (never registered) i2c_client so it holds the addressing information
  116. * needed by those system calls and by this SMBus interface.
  117. */
  118. static ssize_t i2cdev_read(struct file *file, char __user *buf, size_t count,
  119. loff_t *offset)
  120. {
  121. char *tmp;
  122. int ret;
  123. struct i2c_client *client = file->private_data;
  124. if (count > 8192)
  125. count = 8192;
  126. tmp = kmalloc(count, GFP_KERNEL);
  127. if (tmp == NULL)
  128. return -ENOMEM;
  129. pr_debug("i2c-dev: i2c-%d reading %zu bytes.\n",
  130. iminor(file_inode(file)), count);
  131. ret = i2c_master_recv(client, tmp, count);
  132. if (ret >= 0)
  133. ret = copy_to_user(buf, tmp, count) ? -EFAULT : ret;
  134. kfree(tmp);
  135. return ret;
  136. }
  137. static ssize_t i2cdev_write(struct file *file, const char __user *buf,
  138. size_t count, loff_t *offset)
  139. {
  140. int ret;
  141. char *tmp;
  142. struct i2c_client *client = file->private_data;
  143. if (count > 8192)
  144. count = 8192;
  145. tmp = memdup_user(buf, count);
  146. if (IS_ERR(tmp))
  147. return PTR_ERR(tmp);
  148. pr_debug("i2c-dev: i2c-%d writing %zu bytes.\n",
  149. iminor(file_inode(file)), count);
  150. ret = i2c_master_send(client, tmp, count);
  151. kfree(tmp);
  152. return ret;
  153. }
  154. static int i2cdev_check(struct device *dev, void *addrp)
  155. {
  156. struct i2c_client *client = i2c_verify_client(dev);
  157. if (!client || client->addr != *(unsigned int *)addrp)
  158. return 0;
  159. return dev->driver ? -EBUSY : 0;
  160. }
  161. /* walk up mux tree */
  162. static int i2cdev_check_mux_parents(struct i2c_adapter *adapter, int addr)
  163. {
  164. struct i2c_adapter *parent = i2c_parent_is_i2c_adapter(adapter);
  165. int result;
  166. result = device_for_each_child(&adapter->dev, &addr, i2cdev_check);
  167. if (!result && parent)
  168. result = i2cdev_check_mux_parents(parent, addr);
  169. return result;
  170. }
  171. /* recurse down mux tree */
  172. static int i2cdev_check_mux_children(struct device *dev, void *addrp)
  173. {
  174. int result;
  175. if (dev->type == &i2c_adapter_type)
  176. result = device_for_each_child(dev, addrp,
  177. i2cdev_check_mux_children);
  178. else
  179. result = i2cdev_check(dev, addrp);
  180. return result;
  181. }
  182. /* This address checking function differs from the one in i2c-core
  183. in that it considers an address with a registered device, but no
  184. driver bound to it, as NOT busy. */
  185. static int i2cdev_check_addr(struct i2c_adapter *adapter, unsigned int addr)
  186. {
  187. struct i2c_adapter *parent = i2c_parent_is_i2c_adapter(adapter);
  188. int result = 0;
  189. if (parent)
  190. result = i2cdev_check_mux_parents(parent, addr);
  191. if (!result)
  192. result = device_for_each_child(&adapter->dev, &addr,
  193. i2cdev_check_mux_children);
  194. return result;
  195. }
  196. static noinline int i2cdev_ioctl_rdwr(struct i2c_client *client,
  197. unsigned nmsgs, struct i2c_msg *msgs)
  198. {
  199. u8 __user **data_ptrs;
  200. int i, res;
  201. data_ptrs = kmalloc(nmsgs * sizeof(u8 __user *), GFP_KERNEL);
  202. if (data_ptrs == NULL) {
  203. kfree(msgs);
  204. return -ENOMEM;
  205. }
  206. res = 0;
  207. for (i = 0; i < nmsgs; i++) {
  208. /* Limit the size of the message to a sane amount */
  209. if (msgs[i].len > 8192) {
  210. res = -EINVAL;
  211. break;
  212. }
  213. data_ptrs[i] = (u8 __user *)msgs[i].buf;
  214. msgs[i].buf = memdup_user(data_ptrs[i], msgs[i].len);
  215. if (IS_ERR(msgs[i].buf)) {
  216. res = PTR_ERR(msgs[i].buf);
  217. break;
  218. }
  219. /*
  220. * If the message length is received from the slave (similar
  221. * to SMBus block read), we must ensure that the buffer will
  222. * be large enough to cope with a message length of
  223. * I2C_SMBUS_BLOCK_MAX as this is the maximum underlying bus
  224. * drivers allow. The first byte in the buffer must be
  225. * pre-filled with the number of extra bytes, which must be
  226. * at least one to hold the message length, but can be
  227. * greater (for example to account for a checksum byte at
  228. * the end of the message.)
  229. */
  230. if (msgs[i].flags & I2C_M_RECV_LEN) {
  231. if (!(msgs[i].flags & I2C_M_RD) ||
  232. msgs[i].buf[0] < 1 ||
  233. msgs[i].len < msgs[i].buf[0] +
  234. I2C_SMBUS_BLOCK_MAX) {
  235. res = -EINVAL;
  236. break;
  237. }
  238. msgs[i].len = msgs[i].buf[0];
  239. }
  240. }
  241. if (res < 0) {
  242. int j;
  243. for (j = 0; j < i; ++j)
  244. kfree(msgs[j].buf);
  245. kfree(data_ptrs);
  246. kfree(msgs);
  247. return res;
  248. }
  249. res = i2c_transfer(client->adapter, msgs, nmsgs);
  250. while (i-- > 0) {
  251. if (res >= 0 && (msgs[i].flags & I2C_M_RD)) {
  252. if (copy_to_user(data_ptrs[i], msgs[i].buf,
  253. msgs[i].len))
  254. res = -EFAULT;
  255. }
  256. kfree(msgs[i].buf);
  257. }
  258. kfree(data_ptrs);
  259. kfree(msgs);
  260. return res;
  261. }
  262. static noinline int i2cdev_ioctl_smbus(struct i2c_client *client,
  263. u8 read_write, u8 command, u32 size,
  264. union i2c_smbus_data __user *data)
  265. {
  266. union i2c_smbus_data temp = {};
  267. int datasize, res;
  268. if ((size != I2C_SMBUS_BYTE) &&
  269. (size != I2C_SMBUS_QUICK) &&
  270. (size != I2C_SMBUS_BYTE_DATA) &&
  271. (size != I2C_SMBUS_WORD_DATA) &&
  272. (size != I2C_SMBUS_PROC_CALL) &&
  273. (size != I2C_SMBUS_BLOCK_DATA) &&
  274. (size != I2C_SMBUS_I2C_BLOCK_BROKEN) &&
  275. (size != I2C_SMBUS_I2C_BLOCK_DATA) &&
  276. (size != I2C_SMBUS_BLOCK_PROC_CALL)) {
  277. dev_dbg(&client->adapter->dev,
  278. "size out of range (%x) in ioctl I2C_SMBUS.\n",
  279. size);
  280. return -EINVAL;
  281. }
  282. /* Note that I2C_SMBUS_READ and I2C_SMBUS_WRITE are 0 and 1,
  283. so the check is valid if size==I2C_SMBUS_QUICK too. */
  284. if ((read_write != I2C_SMBUS_READ) &&
  285. (read_write != I2C_SMBUS_WRITE)) {
  286. dev_dbg(&client->adapter->dev,
  287. "read_write out of range (%x) in ioctl I2C_SMBUS.\n",
  288. read_write);
  289. return -EINVAL;
  290. }
  291. /* Note that command values are always valid! */
  292. if ((size == I2C_SMBUS_QUICK) ||
  293. ((size == I2C_SMBUS_BYTE) &&
  294. (read_write == I2C_SMBUS_WRITE)))
  295. /* These are special: we do not use data */
  296. return i2c_smbus_xfer(client->adapter, client->addr,
  297. client->flags, read_write,
  298. command, size, NULL);
  299. if (data == NULL) {
  300. dev_dbg(&client->adapter->dev,
  301. "data is NULL pointer in ioctl I2C_SMBUS.\n");
  302. return -EINVAL;
  303. }
  304. if ((size == I2C_SMBUS_BYTE_DATA) ||
  305. (size == I2C_SMBUS_BYTE))
  306. datasize = sizeof(data->byte);
  307. else if ((size == I2C_SMBUS_WORD_DATA) ||
  308. (size == I2C_SMBUS_PROC_CALL))
  309. datasize = sizeof(data->word);
  310. else /* size == smbus block, i2c block, or block proc. call */
  311. datasize = sizeof(data->block);
  312. if ((size == I2C_SMBUS_PROC_CALL) ||
  313. (size == I2C_SMBUS_BLOCK_PROC_CALL) ||
  314. (size == I2C_SMBUS_I2C_BLOCK_DATA) ||
  315. (read_write == I2C_SMBUS_WRITE)) {
  316. if (copy_from_user(&temp, data, datasize))
  317. return -EFAULT;
  318. }
  319. if (size == I2C_SMBUS_I2C_BLOCK_BROKEN) {
  320. /* Convert old I2C block commands to the new
  321. convention. This preserves binary compatibility. */
  322. size = I2C_SMBUS_I2C_BLOCK_DATA;
  323. if (read_write == I2C_SMBUS_READ)
  324. temp.block[0] = I2C_SMBUS_BLOCK_MAX;
  325. }
  326. res = i2c_smbus_xfer(client->adapter, client->addr, client->flags,
  327. read_write, command, size, &temp);
  328. if (!res && ((size == I2C_SMBUS_PROC_CALL) ||
  329. (size == I2C_SMBUS_BLOCK_PROC_CALL) ||
  330. (read_write == I2C_SMBUS_READ))) {
  331. if (copy_to_user(data, &temp, datasize))
  332. return -EFAULT;
  333. }
  334. return res;
  335. }
  336. static long i2cdev_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
  337. {
  338. struct i2c_client *client = file->private_data;
  339. unsigned long funcs;
  340. dev_dbg(&client->adapter->dev, "ioctl, cmd=0x%02x, arg=0x%02lx\n",
  341. cmd, arg);
  342. switch (cmd) {
  343. case I2C_SLAVE:
  344. case I2C_SLAVE_FORCE:
  345. if ((arg > 0x3ff) ||
  346. (((client->flags & I2C_M_TEN) == 0) && arg > 0x7f))
  347. return -EINVAL;
  348. if (cmd == I2C_SLAVE && i2cdev_check_addr(client->adapter, arg))
  349. return -EBUSY;
  350. /* REVISIT: address could become busy later */
  351. client->addr = arg;
  352. return 0;
  353. case I2C_TENBIT:
  354. if (arg)
  355. client->flags |= I2C_M_TEN;
  356. else
  357. client->flags &= ~I2C_M_TEN;
  358. return 0;
  359. case I2C_PEC:
  360. /*
  361. * Setting the PEC flag here won't affect kernel drivers,
  362. * which will be using the i2c_client node registered with
  363. * the driver model core. Likewise, when that client has
  364. * the PEC flag already set, the i2c-dev driver won't see
  365. * (or use) this setting.
  366. */
  367. if (arg)
  368. client->flags |= I2C_CLIENT_PEC;
  369. else
  370. client->flags &= ~I2C_CLIENT_PEC;
  371. return 0;
  372. case I2C_FUNCS:
  373. funcs = i2c_get_functionality(client->adapter);
  374. return put_user(funcs, (unsigned long __user *)arg);
  375. case I2C_RDWR: {
  376. struct i2c_rdwr_ioctl_data rdwr_arg;
  377. struct i2c_msg *rdwr_pa;
  378. if (copy_from_user(&rdwr_arg,
  379. (struct i2c_rdwr_ioctl_data __user *)arg,
  380. sizeof(rdwr_arg)))
  381. return -EFAULT;
  382. /* Put an arbitrary limit on the number of messages that can
  383. * be sent at once */
  384. if (rdwr_arg.nmsgs > I2C_RDWR_IOCTL_MAX_MSGS)
  385. return -EINVAL;
  386. rdwr_pa = memdup_user(rdwr_arg.msgs,
  387. rdwr_arg.nmsgs * sizeof(struct i2c_msg));
  388. if (IS_ERR(rdwr_pa))
  389. return PTR_ERR(rdwr_pa);
  390. return i2cdev_ioctl_rdwr(client, rdwr_arg.nmsgs, rdwr_pa);
  391. }
  392. case I2C_SMBUS: {
  393. struct i2c_smbus_ioctl_data data_arg;
  394. if (copy_from_user(&data_arg,
  395. (struct i2c_smbus_ioctl_data __user *) arg,
  396. sizeof(struct i2c_smbus_ioctl_data)))
  397. return -EFAULT;
  398. return i2cdev_ioctl_smbus(client, data_arg.read_write,
  399. data_arg.command,
  400. data_arg.size,
  401. data_arg.data);
  402. }
  403. case I2C_RETRIES:
  404. client->adapter->retries = arg;
  405. break;
  406. case I2C_TIMEOUT:
  407. /* For historical reasons, user-space sets the timeout
  408. * value in units of 10 ms.
  409. */
  410. client->adapter->timeout = msecs_to_jiffies(arg * 10);
  411. break;
  412. default:
  413. /* NOTE: returning a fault code here could cause trouble
  414. * in buggy userspace code. Some old kernel bugs returned
  415. * zero in this case, and userspace code might accidentally
  416. * have depended on that bug.
  417. */
  418. return -ENOTTY;
  419. }
  420. return 0;
  421. }
  422. #ifdef CONFIG_COMPAT
  423. struct i2c_smbus_ioctl_data32 {
  424. u8 read_write;
  425. u8 command;
  426. u32 size;
  427. compat_caddr_t data; /* union i2c_smbus_data *data */
  428. };
  429. struct i2c_msg32 {
  430. u16 addr;
  431. u16 flags;
  432. u16 len;
  433. compat_caddr_t buf;
  434. };
  435. struct i2c_rdwr_ioctl_data32 {
  436. compat_caddr_t msgs; /* struct i2c_msg __user *msgs */
  437. u32 nmsgs;
  438. };
  439. static long compat_i2cdev_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
  440. {
  441. struct i2c_client *client = file->private_data;
  442. unsigned long funcs;
  443. switch (cmd) {
  444. case I2C_FUNCS:
  445. funcs = i2c_get_functionality(client->adapter);
  446. return put_user(funcs, (compat_ulong_t __user *)arg);
  447. case I2C_RDWR: {
  448. struct i2c_rdwr_ioctl_data32 rdwr_arg;
  449. struct i2c_msg32 *p;
  450. struct i2c_msg *rdwr_pa;
  451. int i;
  452. if (copy_from_user(&rdwr_arg,
  453. (struct i2c_rdwr_ioctl_data32 __user *)arg,
  454. sizeof(rdwr_arg)))
  455. return -EFAULT;
  456. if (rdwr_arg.nmsgs > I2C_RDWR_IOCTL_MAX_MSGS)
  457. return -EINVAL;
  458. rdwr_pa = kmalloc_array(rdwr_arg.nmsgs, sizeof(struct i2c_msg),
  459. GFP_KERNEL);
  460. if (!rdwr_pa)
  461. return -ENOMEM;
  462. p = compat_ptr(rdwr_arg.msgs);
  463. for (i = 0; i < rdwr_arg.nmsgs; i++) {
  464. struct i2c_msg32 umsg;
  465. if (copy_from_user(&umsg, p + i, sizeof(umsg))) {
  466. kfree(rdwr_pa);
  467. return -EFAULT;
  468. }
  469. rdwr_pa[i] = (struct i2c_msg) {
  470. .addr = umsg.addr,
  471. .flags = umsg.flags,
  472. .len = umsg.len,
  473. .buf = compat_ptr(umsg.buf)
  474. };
  475. }
  476. return i2cdev_ioctl_rdwr(client, rdwr_arg.nmsgs, rdwr_pa);
  477. }
  478. case I2C_SMBUS: {
  479. struct i2c_smbus_ioctl_data32 data32;
  480. if (copy_from_user(&data32,
  481. (void __user *) arg,
  482. sizeof(data32)))
  483. return -EFAULT;
  484. return i2cdev_ioctl_smbus(client, data32.read_write,
  485. data32.command,
  486. data32.size,
  487. compat_ptr(data32.data));
  488. }
  489. default:
  490. return i2cdev_ioctl(file, cmd, arg);
  491. }
  492. }
  493. #else
  494. #define compat_i2cdev_ioctl NULL
  495. #endif
  496. static int i2cdev_open(struct inode *inode, struct file *file)
  497. {
  498. unsigned int minor = iminor(inode);
  499. struct i2c_client *client;
  500. struct i2c_adapter *adap;
  501. adap = i2c_get_adapter(minor);
  502. if (!adap)
  503. return -ENODEV;
  504. /* This creates an anonymous i2c_client, which may later be
  505. * pointed to some address using I2C_SLAVE or I2C_SLAVE_FORCE.
  506. *
  507. * This client is ** NEVER REGISTERED ** with the driver model
  508. * or I2C core code!! It just holds private copies of addressing
  509. * information and maybe a PEC flag.
  510. */
  511. client = kzalloc(sizeof(*client), GFP_KERNEL);
  512. if (!client) {
  513. i2c_put_adapter(adap);
  514. return -ENOMEM;
  515. }
  516. snprintf(client->name, I2C_NAME_SIZE, "i2c-dev %d", adap->nr);
  517. client->adapter = adap;
  518. file->private_data = client;
  519. return 0;
  520. }
  521. static int i2cdev_release(struct inode *inode, struct file *file)
  522. {
  523. struct i2c_client *client = file->private_data;
  524. i2c_put_adapter(client->adapter);
  525. kfree(client);
  526. file->private_data = NULL;
  527. return 0;
  528. }
  529. static const struct file_operations i2cdev_fops = {
  530. .owner = THIS_MODULE,
  531. .llseek = no_llseek,
  532. .read = i2cdev_read,
  533. .write = i2cdev_write,
  534. .unlocked_ioctl = i2cdev_ioctl,
  535. .compat_ioctl = compat_i2cdev_ioctl,
  536. .open = i2cdev_open,
  537. .release = i2cdev_release,
  538. };
  539. /* ------------------------------------------------------------------------- */
  540. static struct class *i2c_dev_class;
  541. static int i2cdev_attach_adapter(struct device *dev, void *dummy)
  542. {
  543. struct i2c_adapter *adap;
  544. struct i2c_dev *i2c_dev;
  545. int res;
  546. if (dev->type != &i2c_adapter_type)
  547. return 0;
  548. adap = to_i2c_adapter(dev);
  549. i2c_dev = get_free_i2c_dev(adap);
  550. if (IS_ERR(i2c_dev))
  551. return PTR_ERR(i2c_dev);
  552. cdev_init(&i2c_dev->cdev, &i2cdev_fops);
  553. i2c_dev->cdev.owner = THIS_MODULE;
  554. res = cdev_add(&i2c_dev->cdev, MKDEV(I2C_MAJOR, adap->nr), 1);
  555. if (res)
  556. goto error_cdev;
  557. /* register this i2c device with the driver core */
  558. i2c_dev->dev = device_create(i2c_dev_class, &adap->dev,
  559. MKDEV(I2C_MAJOR, adap->nr), NULL,
  560. "i2c-%d", adap->nr);
  561. if (IS_ERR(i2c_dev->dev)) {
  562. res = PTR_ERR(i2c_dev->dev);
  563. goto error;
  564. }
  565. pr_debug("i2c-dev: adapter [%s] registered as minor %d\n",
  566. adap->name, adap->nr);
  567. return 0;
  568. error:
  569. cdev_del(&i2c_dev->cdev);
  570. error_cdev:
  571. put_i2c_dev(i2c_dev);
  572. return res;
  573. }
  574. static int i2cdev_detach_adapter(struct device *dev, void *dummy)
  575. {
  576. struct i2c_adapter *adap;
  577. struct i2c_dev *i2c_dev;
  578. if (dev->type != &i2c_adapter_type)
  579. return 0;
  580. adap = to_i2c_adapter(dev);
  581. i2c_dev = i2c_dev_get_by_minor(adap->nr);
  582. if (!i2c_dev) /* attach_adapter must have failed */
  583. return 0;
  584. cdev_del(&i2c_dev->cdev);
  585. put_i2c_dev(i2c_dev);
  586. device_destroy(i2c_dev_class, MKDEV(I2C_MAJOR, adap->nr));
  587. pr_debug("i2c-dev: adapter [%s] unregistered\n", adap->name);
  588. return 0;
  589. }
  590. static int i2cdev_notifier_call(struct notifier_block *nb, unsigned long action,
  591. void *data)
  592. {
  593. struct device *dev = data;
  594. switch (action) {
  595. case BUS_NOTIFY_ADD_DEVICE:
  596. return i2cdev_attach_adapter(dev, NULL);
  597. case BUS_NOTIFY_DEL_DEVICE:
  598. return i2cdev_detach_adapter(dev, NULL);
  599. }
  600. return 0;
  601. }
  602. static struct notifier_block i2cdev_notifier = {
  603. .notifier_call = i2cdev_notifier_call,
  604. };
  605. /* ------------------------------------------------------------------------- */
  606. /*
  607. * module load/unload record keeping
  608. */
  609. static int __init i2c_dev_init(void)
  610. {
  611. int res;
  612. printk(KERN_INFO "i2c /dev entries driver\n");
  613. res = register_chrdev_region(MKDEV(I2C_MAJOR, 0), I2C_MINORS, "i2c");
  614. if (res)
  615. goto out;
  616. i2c_dev_class = class_create(THIS_MODULE, "i2c-dev");
  617. if (IS_ERR(i2c_dev_class)) {
  618. res = PTR_ERR(i2c_dev_class);
  619. goto out_unreg_chrdev;
  620. }
  621. i2c_dev_class->dev_groups = i2c_groups;
  622. /* Keep track of adapters which will be added or removed later */
  623. res = bus_register_notifier(&i2c_bus_type, &i2cdev_notifier);
  624. if (res)
  625. goto out_unreg_class;
  626. /* Bind to already existing adapters right away */
  627. i2c_for_each_dev(NULL, i2cdev_attach_adapter);
  628. return 0;
  629. out_unreg_class:
  630. class_destroy(i2c_dev_class);
  631. out_unreg_chrdev:
  632. unregister_chrdev_region(MKDEV(I2C_MAJOR, 0), I2C_MINORS);
  633. out:
  634. printk(KERN_ERR "%s: Driver Initialisation failed\n", __FILE__);
  635. return res;
  636. }
  637. static void __exit i2c_dev_exit(void)
  638. {
  639. bus_unregister_notifier(&i2c_bus_type, &i2cdev_notifier);
  640. i2c_for_each_dev(NULL, i2cdev_detach_adapter);
  641. class_destroy(i2c_dev_class);
  642. unregister_chrdev_region(MKDEV(I2C_MAJOR, 0), I2C_MINORS);
  643. }
  644. MODULE_AUTHOR("Frodo Looijaard <frodol@dds.nl> and "
  645. "Simon G. Vogl <simon@tk.uni-linz.ac.at>");
  646. MODULE_DESCRIPTION("I2C /dev entries driver");
  647. MODULE_LICENSE("GPL");
  648. module_init(i2c_dev_init);
  649. module_exit(i2c_dev_exit);