lirc_dev.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834
  1. /*
  2. * LIRC base driver
  3. *
  4. * by Artur Lipowski <alipowski@interia.pl>
  5. *
  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. *
  11. * This program is distributed in the hope that it will be useful,
  12. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  14. * GNU General Public License for more details.
  15. *
  16. * You should have received a copy of the GNU General Public License
  17. * along with this program; if not, write to the Free Software
  18. * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
  19. *
  20. */
  21. #include <linux/module.h>
  22. #include <linux/kernel.h>
  23. #include <linux/sched.h>
  24. #include <linux/errno.h>
  25. #include <linux/ioctl.h>
  26. #include <linux/fs.h>
  27. #include <linux/poll.h>
  28. #include <linux/completion.h>
  29. #include <linux/mutex.h>
  30. #include <linux/wait.h>
  31. #include <linux/unistd.h>
  32. #include <linux/kthread.h>
  33. #include <linux/bitops.h>
  34. #include <linux/device.h>
  35. #include <linux/cdev.h>
  36. #include <media/lirc.h>
  37. #include <media/lirc_dev.h>
  38. static bool debug;
  39. #define IRCTL_DEV_NAME "BaseRemoteCtl"
  40. #define NOPLUG -1
  41. #define LOGHEAD "lirc_dev (%s[%d]): "
  42. static dev_t lirc_base_dev;
  43. struct irctl {
  44. struct lirc_driver d;
  45. int attached;
  46. int open;
  47. struct mutex irctl_lock;
  48. struct lirc_buffer *buf;
  49. unsigned int chunk_size;
  50. struct cdev *cdev;
  51. struct task_struct *task;
  52. long jiffies_to_wait;
  53. };
  54. static DEFINE_MUTEX(lirc_dev_lock);
  55. static struct irctl *irctls[MAX_IRCTL_DEVICES];
  56. /* Only used for sysfs but defined to void otherwise */
  57. static struct class *lirc_class;
  58. /* helper function
  59. * initializes the irctl structure
  60. */
  61. static void lirc_irctl_init(struct irctl *ir)
  62. {
  63. mutex_init(&ir->irctl_lock);
  64. ir->d.minor = NOPLUG;
  65. }
  66. static void lirc_irctl_cleanup(struct irctl *ir)
  67. {
  68. dev_dbg(ir->d.dev, LOGHEAD "cleaning up\n", ir->d.name, ir->d.minor);
  69. device_destroy(lirc_class, MKDEV(MAJOR(lirc_base_dev), ir->d.minor));
  70. if (ir->buf != ir->d.rbuf) {
  71. lirc_buffer_free(ir->buf);
  72. kfree(ir->buf);
  73. }
  74. ir->buf = NULL;
  75. }
  76. /* helper function
  77. * reads key codes from driver and puts them into buffer
  78. * returns 0 on success
  79. */
  80. static int lirc_add_to_buf(struct irctl *ir)
  81. {
  82. if (ir->d.add_to_buf) {
  83. int res = -ENODATA;
  84. int got_data = 0;
  85. /*
  86. * service the device as long as it is returning
  87. * data and we have space
  88. */
  89. get_data:
  90. res = ir->d.add_to_buf(ir->d.data, ir->buf);
  91. if (res == 0) {
  92. got_data++;
  93. goto get_data;
  94. }
  95. if (res == -ENODEV)
  96. kthread_stop(ir->task);
  97. return got_data ? 0 : res;
  98. }
  99. return 0;
  100. }
  101. /* main function of the polling thread
  102. */
  103. static int lirc_thread(void *irctl)
  104. {
  105. struct irctl *ir = irctl;
  106. dev_dbg(ir->d.dev, LOGHEAD "poll thread started\n",
  107. ir->d.name, ir->d.minor);
  108. do {
  109. if (ir->open) {
  110. if (ir->jiffies_to_wait) {
  111. set_current_state(TASK_INTERRUPTIBLE);
  112. schedule_timeout(ir->jiffies_to_wait);
  113. }
  114. if (kthread_should_stop())
  115. break;
  116. if (!lirc_add_to_buf(ir))
  117. wake_up_interruptible(&ir->buf->wait_poll);
  118. } else {
  119. set_current_state(TASK_INTERRUPTIBLE);
  120. schedule();
  121. }
  122. } while (!kthread_should_stop());
  123. dev_dbg(ir->d.dev, LOGHEAD "poll thread ended\n",
  124. ir->d.name, ir->d.minor);
  125. return 0;
  126. }
  127. static struct file_operations lirc_dev_fops = {
  128. .owner = THIS_MODULE,
  129. .read = lirc_dev_fop_read,
  130. .write = lirc_dev_fop_write,
  131. .poll = lirc_dev_fop_poll,
  132. .unlocked_ioctl = lirc_dev_fop_ioctl,
  133. #ifdef CONFIG_COMPAT
  134. .compat_ioctl = lirc_dev_fop_ioctl,
  135. #endif
  136. .open = lirc_dev_fop_open,
  137. .release = lirc_dev_fop_close,
  138. .llseek = noop_llseek,
  139. };
  140. static int lirc_cdev_add(struct irctl *ir)
  141. {
  142. int retval = -ENOMEM;
  143. struct lirc_driver *d = &ir->d;
  144. struct cdev *cdev;
  145. cdev = kzalloc(sizeof(*cdev), GFP_KERNEL);
  146. if (!cdev)
  147. goto err_out;
  148. if (d->fops) {
  149. cdev_init(cdev, d->fops);
  150. cdev->owner = d->owner;
  151. } else {
  152. cdev_init(cdev, &lirc_dev_fops);
  153. cdev->owner = THIS_MODULE;
  154. }
  155. retval = kobject_set_name(&cdev->kobj, "lirc%d", d->minor);
  156. if (retval)
  157. goto err_out;
  158. retval = cdev_add(cdev, MKDEV(MAJOR(lirc_base_dev), d->minor), 1);
  159. if (retval) {
  160. kobject_put(&cdev->kobj);
  161. goto err_out;
  162. }
  163. ir->cdev = cdev;
  164. return 0;
  165. err_out:
  166. kfree(cdev);
  167. return retval;
  168. }
  169. int lirc_register_driver(struct lirc_driver *d)
  170. {
  171. struct irctl *ir;
  172. int minor;
  173. int bytes_in_key;
  174. unsigned int chunk_size;
  175. unsigned int buffer_size;
  176. int err;
  177. if (!d) {
  178. printk(KERN_ERR "lirc_dev: lirc_register_driver: "
  179. "driver pointer must be not NULL!\n");
  180. err = -EBADRQC;
  181. goto out;
  182. }
  183. if (!d->dev) {
  184. printk(KERN_ERR "%s: dev pointer not filled in!\n", __func__);
  185. err = -EINVAL;
  186. goto out;
  187. }
  188. if (MAX_IRCTL_DEVICES <= d->minor) {
  189. dev_err(d->dev, "lirc_dev: lirc_register_driver: "
  190. "\"minor\" must be between 0 and %d (%d)!\n",
  191. MAX_IRCTL_DEVICES - 1, d->minor);
  192. err = -EBADRQC;
  193. goto out;
  194. }
  195. if (1 > d->code_length || (BUFLEN * 8) < d->code_length) {
  196. dev_err(d->dev, "lirc_dev: lirc_register_driver: "
  197. "code length in bits for minor (%d) "
  198. "must be less than %d!\n",
  199. d->minor, BUFLEN * 8);
  200. err = -EBADRQC;
  201. goto out;
  202. }
  203. dev_dbg(d->dev, "lirc_dev: lirc_register_driver: sample_rate: %d\n",
  204. d->sample_rate);
  205. if (d->sample_rate) {
  206. if (2 > d->sample_rate || HZ < d->sample_rate) {
  207. dev_err(d->dev, "lirc_dev: lirc_register_driver: "
  208. "sample_rate must be between 2 and %d!\n", HZ);
  209. err = -EBADRQC;
  210. goto out;
  211. }
  212. if (!d->add_to_buf) {
  213. dev_err(d->dev, "lirc_dev: lirc_register_driver: "
  214. "add_to_buf cannot be NULL when "
  215. "sample_rate is set\n");
  216. err = -EBADRQC;
  217. goto out;
  218. }
  219. } else if (!(d->fops && d->fops->read) && !d->rbuf) {
  220. dev_err(d->dev, "lirc_dev: lirc_register_driver: "
  221. "fops->read and rbuf cannot all be NULL!\n");
  222. err = -EBADRQC;
  223. goto out;
  224. } else if (!d->rbuf) {
  225. if (!(d->fops && d->fops->read && d->fops->poll &&
  226. d->fops->unlocked_ioctl)) {
  227. dev_err(d->dev, "lirc_dev: lirc_register_driver: "
  228. "neither read, poll nor unlocked_ioctl can be NULL!\n");
  229. err = -EBADRQC;
  230. goto out;
  231. }
  232. }
  233. mutex_lock(&lirc_dev_lock);
  234. minor = d->minor;
  235. if (minor < 0) {
  236. /* find first free slot for driver */
  237. for (minor = 0; minor < MAX_IRCTL_DEVICES; minor++)
  238. if (!irctls[minor])
  239. break;
  240. if (MAX_IRCTL_DEVICES == minor) {
  241. dev_err(d->dev, "lirc_dev: lirc_register_driver: "
  242. "no free slots for drivers!\n");
  243. err = -ENOMEM;
  244. goto out_lock;
  245. }
  246. } else if (irctls[minor]) {
  247. dev_err(d->dev, "lirc_dev: lirc_register_driver: "
  248. "minor (%d) just registered!\n", minor);
  249. err = -EBUSY;
  250. goto out_lock;
  251. }
  252. ir = kzalloc(sizeof(struct irctl), GFP_KERNEL);
  253. if (!ir) {
  254. err = -ENOMEM;
  255. goto out_lock;
  256. }
  257. lirc_irctl_init(ir);
  258. irctls[minor] = ir;
  259. d->minor = minor;
  260. if (d->sample_rate) {
  261. ir->jiffies_to_wait = HZ / d->sample_rate;
  262. } else {
  263. /* it means - wait for external event in task queue */
  264. ir->jiffies_to_wait = 0;
  265. }
  266. /* some safety check 8-) */
  267. d->name[sizeof(d->name)-1] = '\0';
  268. bytes_in_key = BITS_TO_LONGS(d->code_length) +
  269. (d->code_length % 8 ? 1 : 0);
  270. buffer_size = d->buffer_size ? d->buffer_size : BUFLEN / bytes_in_key;
  271. chunk_size = d->chunk_size ? d->chunk_size : bytes_in_key;
  272. if (d->rbuf) {
  273. ir->buf = d->rbuf;
  274. } else {
  275. ir->buf = kmalloc(sizeof(struct lirc_buffer), GFP_KERNEL);
  276. if (!ir->buf) {
  277. err = -ENOMEM;
  278. goto out_lock;
  279. }
  280. err = lirc_buffer_init(ir->buf, chunk_size, buffer_size);
  281. if (err) {
  282. kfree(ir->buf);
  283. goto out_lock;
  284. }
  285. }
  286. ir->chunk_size = ir->buf->chunk_size;
  287. if (d->features == 0)
  288. d->features = LIRC_CAN_REC_LIRCCODE;
  289. ir->d = *d;
  290. device_create(lirc_class, ir->d.dev,
  291. MKDEV(MAJOR(lirc_base_dev), ir->d.minor), NULL,
  292. "lirc%u", ir->d.minor);
  293. if (d->sample_rate) {
  294. /* try to fire up polling thread */
  295. ir->task = kthread_run(lirc_thread, (void *)ir, "lirc_dev");
  296. if (IS_ERR(ir->task)) {
  297. dev_err(d->dev, "lirc_dev: lirc_register_driver: "
  298. "cannot run poll thread for minor = %d\n",
  299. d->minor);
  300. err = -ECHILD;
  301. goto out_sysfs;
  302. }
  303. }
  304. err = lirc_cdev_add(ir);
  305. if (err)
  306. goto out_sysfs;
  307. ir->attached = 1;
  308. mutex_unlock(&lirc_dev_lock);
  309. dev_info(ir->d.dev, "lirc_dev: driver %s registered at minor = %d\n",
  310. ir->d.name, ir->d.minor);
  311. return minor;
  312. out_sysfs:
  313. device_destroy(lirc_class, MKDEV(MAJOR(lirc_base_dev), ir->d.minor));
  314. out_lock:
  315. mutex_unlock(&lirc_dev_lock);
  316. out:
  317. return err;
  318. }
  319. EXPORT_SYMBOL(lirc_register_driver);
  320. int lirc_unregister_driver(int minor)
  321. {
  322. struct irctl *ir;
  323. struct cdev *cdev;
  324. if (minor < 0 || minor >= MAX_IRCTL_DEVICES) {
  325. printk(KERN_ERR "lirc_dev: %s: minor (%d) must be between "
  326. "0 and %d!\n", __func__, minor, MAX_IRCTL_DEVICES - 1);
  327. return -EBADRQC;
  328. }
  329. ir = irctls[minor];
  330. if (!ir) {
  331. printk(KERN_ERR "lirc_dev: %s: failed to get irctl struct "
  332. "for minor %d!\n", __func__, minor);
  333. return -ENOENT;
  334. }
  335. cdev = ir->cdev;
  336. mutex_lock(&lirc_dev_lock);
  337. if (ir->d.minor != minor) {
  338. printk(KERN_ERR "lirc_dev: %s: minor (%d) device not "
  339. "registered!\n", __func__, minor);
  340. mutex_unlock(&lirc_dev_lock);
  341. return -ENOENT;
  342. }
  343. /* end up polling thread */
  344. if (ir->task)
  345. kthread_stop(ir->task);
  346. dev_dbg(ir->d.dev, "lirc_dev: driver %s unregistered from minor = %d\n",
  347. ir->d.name, ir->d.minor);
  348. ir->attached = 0;
  349. if (ir->open) {
  350. dev_dbg(ir->d.dev, LOGHEAD "releasing opened driver\n",
  351. ir->d.name, ir->d.minor);
  352. wake_up_interruptible(&ir->buf->wait_poll);
  353. mutex_lock(&ir->irctl_lock);
  354. ir->d.set_use_dec(ir->d.data);
  355. module_put(cdev->owner);
  356. mutex_unlock(&ir->irctl_lock);
  357. } else {
  358. lirc_irctl_cleanup(ir);
  359. cdev_del(cdev);
  360. kfree(cdev);
  361. kfree(ir);
  362. irctls[minor] = NULL;
  363. }
  364. mutex_unlock(&lirc_dev_lock);
  365. return 0;
  366. }
  367. EXPORT_SYMBOL(lirc_unregister_driver);
  368. int lirc_dev_fop_open(struct inode *inode, struct file *file)
  369. {
  370. struct irctl *ir;
  371. struct cdev *cdev;
  372. int retval = 0;
  373. if (iminor(inode) >= MAX_IRCTL_DEVICES) {
  374. printk(KERN_WARNING "lirc_dev [%d]: open result = -ENODEV\n",
  375. iminor(inode));
  376. return -ENODEV;
  377. }
  378. if (mutex_lock_interruptible(&lirc_dev_lock))
  379. return -ERESTARTSYS;
  380. ir = irctls[iminor(inode)];
  381. if (!ir) {
  382. retval = -ENODEV;
  383. goto error;
  384. }
  385. dev_dbg(ir->d.dev, LOGHEAD "open called\n", ir->d.name, ir->d.minor);
  386. if (ir->d.minor == NOPLUG) {
  387. retval = -ENODEV;
  388. goto error;
  389. }
  390. if (ir->open) {
  391. retval = -EBUSY;
  392. goto error;
  393. }
  394. cdev = ir->cdev;
  395. if (try_module_get(cdev->owner)) {
  396. ir->open++;
  397. retval = ir->d.set_use_inc(ir->d.data);
  398. if (retval) {
  399. module_put(cdev->owner);
  400. ir->open--;
  401. } else {
  402. lirc_buffer_clear(ir->buf);
  403. }
  404. if (ir->task)
  405. wake_up_process(ir->task);
  406. }
  407. error:
  408. if (ir)
  409. dev_dbg(ir->d.dev, LOGHEAD "open result = %d\n",
  410. ir->d.name, ir->d.minor, retval);
  411. mutex_unlock(&lirc_dev_lock);
  412. nonseekable_open(inode, file);
  413. return retval;
  414. }
  415. EXPORT_SYMBOL(lirc_dev_fop_open);
  416. int lirc_dev_fop_close(struct inode *inode, struct file *file)
  417. {
  418. struct irctl *ir = irctls[iminor(inode)];
  419. struct cdev *cdev;
  420. if (!ir) {
  421. printk(KERN_ERR "%s: called with invalid irctl\n", __func__);
  422. return -EINVAL;
  423. }
  424. cdev = ir->cdev;
  425. dev_dbg(ir->d.dev, LOGHEAD "close called\n", ir->d.name, ir->d.minor);
  426. WARN_ON(mutex_lock_killable(&lirc_dev_lock));
  427. ir->open--;
  428. if (ir->attached) {
  429. ir->d.set_use_dec(ir->d.data);
  430. module_put(cdev->owner);
  431. } else {
  432. lirc_irctl_cleanup(ir);
  433. cdev_del(cdev);
  434. irctls[ir->d.minor] = NULL;
  435. kfree(cdev);
  436. kfree(ir);
  437. }
  438. mutex_unlock(&lirc_dev_lock);
  439. return 0;
  440. }
  441. EXPORT_SYMBOL(lirc_dev_fop_close);
  442. unsigned int lirc_dev_fop_poll(struct file *file, poll_table *wait)
  443. {
  444. struct irctl *ir = irctls[iminor(file->f_dentry->d_inode)];
  445. unsigned int ret;
  446. if (!ir) {
  447. printk(KERN_ERR "%s: called with invalid irctl\n", __func__);
  448. return POLLERR;
  449. }
  450. dev_dbg(ir->d.dev, LOGHEAD "poll called\n", ir->d.name, ir->d.minor);
  451. if (!ir->attached)
  452. return POLLERR;
  453. poll_wait(file, &ir->buf->wait_poll, wait);
  454. if (ir->buf)
  455. if (lirc_buffer_empty(ir->buf))
  456. ret = 0;
  457. else
  458. ret = POLLIN | POLLRDNORM;
  459. else
  460. ret = POLLERR;
  461. dev_dbg(ir->d.dev, LOGHEAD "poll result = %d\n",
  462. ir->d.name, ir->d.minor, ret);
  463. return ret;
  464. }
  465. EXPORT_SYMBOL(lirc_dev_fop_poll);
  466. long lirc_dev_fop_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
  467. {
  468. __u32 mode;
  469. int result = 0;
  470. struct irctl *ir = irctls[iminor(file->f_dentry->d_inode)];
  471. if (!ir) {
  472. printk(KERN_ERR "lirc_dev: %s: no irctl found!\n", __func__);
  473. return -ENODEV;
  474. }
  475. dev_dbg(ir->d.dev, LOGHEAD "ioctl called (0x%x)\n",
  476. ir->d.name, ir->d.minor, cmd);
  477. if (ir->d.minor == NOPLUG || !ir->attached) {
  478. dev_dbg(ir->d.dev, LOGHEAD "ioctl result = -ENODEV\n",
  479. ir->d.name, ir->d.minor);
  480. return -ENODEV;
  481. }
  482. mutex_lock(&ir->irctl_lock);
  483. switch (cmd) {
  484. case LIRC_GET_FEATURES:
  485. result = put_user(ir->d.features, (__u32 *)arg);
  486. break;
  487. case LIRC_GET_REC_MODE:
  488. if (!(ir->d.features & LIRC_CAN_REC_MASK)) {
  489. result = -ENOSYS;
  490. break;
  491. }
  492. result = put_user(LIRC_REC2MODE
  493. (ir->d.features & LIRC_CAN_REC_MASK),
  494. (__u32 *)arg);
  495. break;
  496. case LIRC_SET_REC_MODE:
  497. if (!(ir->d.features & LIRC_CAN_REC_MASK)) {
  498. result = -ENOSYS;
  499. break;
  500. }
  501. result = get_user(mode, (__u32 *)arg);
  502. if (!result && !(LIRC_MODE2REC(mode) & ir->d.features))
  503. result = -EINVAL;
  504. /*
  505. * FIXME: We should actually set the mode somehow but
  506. * for now, lirc_serial doesn't support mode changing either
  507. */
  508. break;
  509. case LIRC_GET_LENGTH:
  510. result = put_user(ir->d.code_length, (__u32 *)arg);
  511. break;
  512. case LIRC_GET_MIN_TIMEOUT:
  513. if (!(ir->d.features & LIRC_CAN_SET_REC_TIMEOUT) ||
  514. ir->d.min_timeout == 0) {
  515. result = -ENOSYS;
  516. break;
  517. }
  518. result = put_user(ir->d.min_timeout, (__u32 *)arg);
  519. break;
  520. case LIRC_GET_MAX_TIMEOUT:
  521. if (!(ir->d.features & LIRC_CAN_SET_REC_TIMEOUT) ||
  522. ir->d.max_timeout == 0) {
  523. result = -ENOSYS;
  524. break;
  525. }
  526. result = put_user(ir->d.max_timeout, (__u32 *)arg);
  527. break;
  528. default:
  529. result = -EINVAL;
  530. }
  531. dev_dbg(ir->d.dev, LOGHEAD "ioctl result = %d\n",
  532. ir->d.name, ir->d.minor, result);
  533. mutex_unlock(&ir->irctl_lock);
  534. return result;
  535. }
  536. EXPORT_SYMBOL(lirc_dev_fop_ioctl);
  537. ssize_t lirc_dev_fop_read(struct file *file,
  538. char __user *buffer,
  539. size_t length,
  540. loff_t *ppos)
  541. {
  542. struct irctl *ir = irctls[iminor(file->f_dentry->d_inode)];
  543. unsigned char *buf;
  544. int ret = 0, written = 0;
  545. DECLARE_WAITQUEUE(wait, current);
  546. if (!ir) {
  547. printk(KERN_ERR "%s: called with invalid irctl\n", __func__);
  548. return -ENODEV;
  549. }
  550. dev_dbg(ir->d.dev, LOGHEAD "read called\n", ir->d.name, ir->d.minor);
  551. buf = kzalloc(ir->chunk_size, GFP_KERNEL);
  552. if (!buf)
  553. return -ENOMEM;
  554. if (mutex_lock_interruptible(&ir->irctl_lock)) {
  555. ret = -ERESTARTSYS;
  556. goto out_unlocked;
  557. }
  558. if (!ir->attached) {
  559. ret = -ENODEV;
  560. goto out_locked;
  561. }
  562. if (length % ir->chunk_size) {
  563. ret = -EINVAL;
  564. goto out_locked;
  565. }
  566. /*
  567. * we add ourselves to the task queue before buffer check
  568. * to avoid losing scan code (in case when queue is awaken somewhere
  569. * between while condition checking and scheduling)
  570. */
  571. add_wait_queue(&ir->buf->wait_poll, &wait);
  572. set_current_state(TASK_INTERRUPTIBLE);
  573. /*
  574. * while we didn't provide 'length' bytes, device is opened in blocking
  575. * mode and 'copy_to_user' is happy, wait for data.
  576. */
  577. while (written < length && ret == 0) {
  578. if (lirc_buffer_empty(ir->buf)) {
  579. /* According to the read(2) man page, 'written' can be
  580. * returned as less than 'length', instead of blocking
  581. * again, returning -EWOULDBLOCK, or returning
  582. * -ERESTARTSYS */
  583. if (written)
  584. break;
  585. if (file->f_flags & O_NONBLOCK) {
  586. ret = -EWOULDBLOCK;
  587. break;
  588. }
  589. if (signal_pending(current)) {
  590. ret = -ERESTARTSYS;
  591. break;
  592. }
  593. mutex_unlock(&ir->irctl_lock);
  594. schedule();
  595. set_current_state(TASK_INTERRUPTIBLE);
  596. if (mutex_lock_interruptible(&ir->irctl_lock)) {
  597. ret = -ERESTARTSYS;
  598. remove_wait_queue(&ir->buf->wait_poll, &wait);
  599. set_current_state(TASK_RUNNING);
  600. goto out_unlocked;
  601. }
  602. if (!ir->attached) {
  603. ret = -ENODEV;
  604. break;
  605. }
  606. } else {
  607. lirc_buffer_read(ir->buf, buf);
  608. ret = copy_to_user((void *)buffer+written, buf,
  609. ir->buf->chunk_size);
  610. if (!ret)
  611. written += ir->buf->chunk_size;
  612. else
  613. ret = -EFAULT;
  614. }
  615. }
  616. remove_wait_queue(&ir->buf->wait_poll, &wait);
  617. set_current_state(TASK_RUNNING);
  618. out_locked:
  619. mutex_unlock(&ir->irctl_lock);
  620. out_unlocked:
  621. kfree(buf);
  622. dev_dbg(ir->d.dev, LOGHEAD "read result = %s (%d)\n",
  623. ir->d.name, ir->d.minor, ret ? "<fail>" : "<ok>", ret);
  624. return ret ? ret : written;
  625. }
  626. EXPORT_SYMBOL(lirc_dev_fop_read);
  627. void *lirc_get_pdata(struct file *file)
  628. {
  629. void *data = NULL;
  630. if (file && file->f_dentry && file->f_dentry->d_inode &&
  631. file->f_dentry->d_inode->i_rdev) {
  632. struct irctl *ir;
  633. ir = irctls[iminor(file->f_dentry->d_inode)];
  634. data = ir->d.data;
  635. }
  636. return data;
  637. }
  638. EXPORT_SYMBOL(lirc_get_pdata);
  639. ssize_t lirc_dev_fop_write(struct file *file, const char __user *buffer,
  640. size_t length, loff_t *ppos)
  641. {
  642. struct irctl *ir = irctls[iminor(file->f_dentry->d_inode)];
  643. if (!ir) {
  644. printk(KERN_ERR "%s: called with invalid irctl\n", __func__);
  645. return -ENODEV;
  646. }
  647. dev_dbg(ir->d.dev, LOGHEAD "write called\n", ir->d.name, ir->d.minor);
  648. if (!ir->attached)
  649. return -ENODEV;
  650. return -EINVAL;
  651. }
  652. EXPORT_SYMBOL(lirc_dev_fop_write);
  653. static int __init lirc_dev_init(void)
  654. {
  655. int retval;
  656. lirc_class = class_create(THIS_MODULE, "lirc");
  657. if (IS_ERR(lirc_class)) {
  658. retval = PTR_ERR(lirc_class);
  659. printk(KERN_ERR "lirc_dev: class_create failed\n");
  660. goto error;
  661. }
  662. retval = alloc_chrdev_region(&lirc_base_dev, 0, MAX_IRCTL_DEVICES,
  663. IRCTL_DEV_NAME);
  664. if (retval) {
  665. class_destroy(lirc_class);
  666. printk(KERN_ERR "lirc_dev: alloc_chrdev_region failed\n");
  667. goto error;
  668. }
  669. printk(KERN_INFO "lirc_dev: IR Remote Control driver registered, "
  670. "major %d \n", MAJOR(lirc_base_dev));
  671. error:
  672. return retval;
  673. }
  674. static void __exit lirc_dev_exit(void)
  675. {
  676. class_destroy(lirc_class);
  677. unregister_chrdev_region(lirc_base_dev, MAX_IRCTL_DEVICES);
  678. printk(KERN_INFO "lirc_dev: module unloaded\n");
  679. }
  680. module_init(lirc_dev_init);
  681. module_exit(lirc_dev_exit);
  682. MODULE_DESCRIPTION("LIRC base driver module");
  683. MODULE_AUTHOR("Artur Lipowski");
  684. MODULE_LICENSE("GPL");
  685. module_param(debug, bool, S_IRUGO | S_IWUSR);
  686. MODULE_PARM_DESC(debug, "Enable debugging messages");