lirc_dev.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837
  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. */
  17. #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  18. #include <linux/module.h>
  19. #include <linux/mutex.h>
  20. #include <linux/device.h>
  21. #include <linux/idr.h>
  22. #include <linux/poll.h>
  23. #include <linux/sched.h>
  24. #include <linux/wait.h>
  25. #include "rc-core-priv.h"
  26. #include <uapi/linux/lirc.h>
  27. #define LIRCBUF_SIZE 256
  28. static dev_t lirc_base_dev;
  29. /* Used to keep track of allocated lirc devices */
  30. static DEFINE_IDA(lirc_ida);
  31. /* Only used for sysfs but defined to void otherwise */
  32. static struct class *lirc_class;
  33. /**
  34. * ir_lirc_raw_event() - Send raw IR data to lirc to be relayed to userspace
  35. *
  36. * @dev: the struct rc_dev descriptor of the device
  37. * @ev: the struct ir_raw_event descriptor of the pulse/space
  38. */
  39. void ir_lirc_raw_event(struct rc_dev *dev, struct ir_raw_event ev)
  40. {
  41. unsigned long flags;
  42. struct lirc_fh *fh;
  43. int sample;
  44. /* Packet start */
  45. if (ev.reset) {
  46. /*
  47. * Userspace expects a long space event before the start of
  48. * the signal to use as a sync. This may be done with repeat
  49. * packets and normal samples. But if a reset has been sent
  50. * then we assume that a long time has passed, so we send a
  51. * space with the maximum time value.
  52. */
  53. sample = LIRC_SPACE(LIRC_VALUE_MASK);
  54. dev_dbg(&dev->dev, "delivering reset sync space to lirc_dev\n");
  55. /* Carrier reports */
  56. } else if (ev.carrier_report) {
  57. sample = LIRC_FREQUENCY(ev.carrier);
  58. dev_dbg(&dev->dev, "carrier report (freq: %d)\n", sample);
  59. /* Packet end */
  60. } else if (ev.timeout) {
  61. if (dev->gap)
  62. return;
  63. dev->gap_start = ktime_get();
  64. dev->gap = true;
  65. dev->gap_duration = ev.duration;
  66. sample = LIRC_TIMEOUT(ev.duration / 1000);
  67. dev_dbg(&dev->dev, "timeout report (duration: %d)\n", sample);
  68. /* Normal sample */
  69. } else {
  70. if (dev->gap) {
  71. dev->gap_duration += ktime_to_ns(ktime_sub(ktime_get(),
  72. dev->gap_start));
  73. /* Convert to ms and cap by LIRC_VALUE_MASK */
  74. do_div(dev->gap_duration, 1000);
  75. dev->gap_duration = min_t(u64, dev->gap_duration,
  76. LIRC_VALUE_MASK);
  77. spin_lock_irqsave(&dev->lirc_fh_lock, flags);
  78. list_for_each_entry(fh, &dev->lirc_fh, list)
  79. kfifo_put(&fh->rawir,
  80. LIRC_SPACE(dev->gap_duration));
  81. spin_unlock_irqrestore(&dev->lirc_fh_lock, flags);
  82. dev->gap = false;
  83. }
  84. sample = ev.pulse ? LIRC_PULSE(ev.duration / 1000) :
  85. LIRC_SPACE(ev.duration / 1000);
  86. dev_dbg(&dev->dev, "delivering %uus %s to lirc_dev\n",
  87. TO_US(ev.duration), TO_STR(ev.pulse));
  88. }
  89. spin_lock_irqsave(&dev->lirc_fh_lock, flags);
  90. list_for_each_entry(fh, &dev->lirc_fh, list) {
  91. if (LIRC_IS_TIMEOUT(sample) && !fh->send_timeout_reports)
  92. continue;
  93. if (kfifo_put(&fh->rawir, sample))
  94. wake_up_poll(&fh->wait_poll, EPOLLIN | EPOLLRDNORM);
  95. }
  96. spin_unlock_irqrestore(&dev->lirc_fh_lock, flags);
  97. }
  98. /**
  99. * ir_lirc_scancode_event() - Send scancode data to lirc to be relayed to
  100. * userspace. This can be called in atomic context.
  101. * @dev: the struct rc_dev descriptor of the device
  102. * @lsc: the struct lirc_scancode describing the decoded scancode
  103. */
  104. void ir_lirc_scancode_event(struct rc_dev *dev, struct lirc_scancode *lsc)
  105. {
  106. unsigned long flags;
  107. struct lirc_fh *fh;
  108. lsc->timestamp = ktime_get_ns();
  109. spin_lock_irqsave(&dev->lirc_fh_lock, flags);
  110. list_for_each_entry(fh, &dev->lirc_fh, list) {
  111. if (kfifo_put(&fh->scancodes, *lsc))
  112. wake_up_poll(&fh->wait_poll, EPOLLIN | EPOLLRDNORM);
  113. }
  114. spin_unlock_irqrestore(&dev->lirc_fh_lock, flags);
  115. }
  116. EXPORT_SYMBOL_GPL(ir_lirc_scancode_event);
  117. static int ir_lirc_open(struct inode *inode, struct file *file)
  118. {
  119. struct rc_dev *dev = container_of(inode->i_cdev, struct rc_dev,
  120. lirc_cdev);
  121. struct lirc_fh *fh = kzalloc(sizeof(*fh), GFP_KERNEL);
  122. unsigned long flags;
  123. int retval;
  124. if (!fh)
  125. return -ENOMEM;
  126. get_device(&dev->dev);
  127. if (!dev->registered) {
  128. retval = -ENODEV;
  129. goto out_fh;
  130. }
  131. if (dev->driver_type == RC_DRIVER_IR_RAW) {
  132. if (kfifo_alloc(&fh->rawir, MAX_IR_EVENT_SIZE, GFP_KERNEL)) {
  133. retval = -ENOMEM;
  134. goto out_fh;
  135. }
  136. }
  137. if (dev->driver_type != RC_DRIVER_IR_RAW_TX) {
  138. if (kfifo_alloc(&fh->scancodes, 32, GFP_KERNEL)) {
  139. retval = -ENOMEM;
  140. goto out_rawir;
  141. }
  142. }
  143. fh->send_mode = LIRC_MODE_PULSE;
  144. fh->rc = dev;
  145. fh->send_timeout_reports = true;
  146. if (dev->driver_type == RC_DRIVER_SCANCODE)
  147. fh->rec_mode = LIRC_MODE_SCANCODE;
  148. else
  149. fh->rec_mode = LIRC_MODE_MODE2;
  150. retval = rc_open(dev);
  151. if (retval)
  152. goto out_kfifo;
  153. init_waitqueue_head(&fh->wait_poll);
  154. file->private_data = fh;
  155. spin_lock_irqsave(&dev->lirc_fh_lock, flags);
  156. list_add(&fh->list, &dev->lirc_fh);
  157. spin_unlock_irqrestore(&dev->lirc_fh_lock, flags);
  158. nonseekable_open(inode, file);
  159. return 0;
  160. out_kfifo:
  161. if (dev->driver_type != RC_DRIVER_IR_RAW_TX)
  162. kfifo_free(&fh->scancodes);
  163. out_rawir:
  164. if (dev->driver_type == RC_DRIVER_IR_RAW)
  165. kfifo_free(&fh->rawir);
  166. out_fh:
  167. kfree(fh);
  168. put_device(&dev->dev);
  169. return retval;
  170. }
  171. static int ir_lirc_close(struct inode *inode, struct file *file)
  172. {
  173. struct lirc_fh *fh = file->private_data;
  174. struct rc_dev *dev = fh->rc;
  175. unsigned long flags;
  176. spin_lock_irqsave(&dev->lirc_fh_lock, flags);
  177. list_del(&fh->list);
  178. spin_unlock_irqrestore(&dev->lirc_fh_lock, flags);
  179. if (dev->driver_type == RC_DRIVER_IR_RAW)
  180. kfifo_free(&fh->rawir);
  181. if (dev->driver_type != RC_DRIVER_IR_RAW_TX)
  182. kfifo_free(&fh->scancodes);
  183. kfree(fh);
  184. rc_close(dev);
  185. put_device(&dev->dev);
  186. return 0;
  187. }
  188. static ssize_t ir_lirc_transmit_ir(struct file *file, const char __user *buf,
  189. size_t n, loff_t *ppos)
  190. {
  191. struct lirc_fh *fh = file->private_data;
  192. struct rc_dev *dev = fh->rc;
  193. unsigned int *txbuf;
  194. struct ir_raw_event *raw = NULL;
  195. ssize_t ret;
  196. size_t count;
  197. ktime_t start;
  198. s64 towait;
  199. unsigned int duration = 0; /* signal duration in us */
  200. int i;
  201. ret = mutex_lock_interruptible(&dev->lock);
  202. if (ret)
  203. return ret;
  204. if (!dev->registered) {
  205. ret = -ENODEV;
  206. goto out_unlock;
  207. }
  208. if (!dev->tx_ir) {
  209. ret = -EINVAL;
  210. goto out_unlock;
  211. }
  212. if (fh->send_mode == LIRC_MODE_SCANCODE) {
  213. struct lirc_scancode scan;
  214. if (n != sizeof(scan)) {
  215. ret = -EINVAL;
  216. goto out_unlock;
  217. }
  218. if (copy_from_user(&scan, buf, sizeof(scan))) {
  219. ret = -EFAULT;
  220. goto out_unlock;
  221. }
  222. if (scan.flags || scan.keycode || scan.timestamp) {
  223. ret = -EINVAL;
  224. goto out_unlock;
  225. }
  226. /*
  227. * The scancode field in lirc_scancode is 64-bit simply
  228. * to future-proof it, since there are IR protocols encode
  229. * use more than 32 bits. For now only 32-bit protocols
  230. * are supported.
  231. */
  232. if (scan.scancode > U32_MAX ||
  233. !rc_validate_scancode(scan.rc_proto, scan.scancode)) {
  234. ret = -EINVAL;
  235. goto out_unlock;
  236. }
  237. raw = kmalloc_array(LIRCBUF_SIZE, sizeof(*raw), GFP_KERNEL);
  238. if (!raw) {
  239. ret = -ENOMEM;
  240. goto out_unlock;
  241. }
  242. ret = ir_raw_encode_scancode(scan.rc_proto, scan.scancode,
  243. raw, LIRCBUF_SIZE);
  244. if (ret < 0)
  245. goto out_kfree_raw;
  246. count = ret;
  247. txbuf = kmalloc_array(count, sizeof(unsigned int), GFP_KERNEL);
  248. if (!txbuf) {
  249. ret = -ENOMEM;
  250. goto out_kfree_raw;
  251. }
  252. for (i = 0; i < count; i++)
  253. /* Convert from NS to US */
  254. txbuf[i] = DIV_ROUND_UP(raw[i].duration, 1000);
  255. if (dev->s_tx_carrier) {
  256. int carrier = ir_raw_encode_carrier(scan.rc_proto);
  257. if (carrier > 0)
  258. dev->s_tx_carrier(dev, carrier);
  259. }
  260. } else {
  261. if (n < sizeof(unsigned int) || n % sizeof(unsigned int)) {
  262. ret = -EINVAL;
  263. goto out_unlock;
  264. }
  265. count = n / sizeof(unsigned int);
  266. if (count > LIRCBUF_SIZE || count % 2 == 0) {
  267. ret = -EINVAL;
  268. goto out_unlock;
  269. }
  270. txbuf = memdup_user(buf, n);
  271. if (IS_ERR(txbuf)) {
  272. ret = PTR_ERR(txbuf);
  273. goto out_unlock;
  274. }
  275. }
  276. for (i = 0; i < count; i++) {
  277. if (txbuf[i] > IR_MAX_DURATION / 1000 - duration || !txbuf[i]) {
  278. ret = -EINVAL;
  279. goto out_kfree;
  280. }
  281. duration += txbuf[i];
  282. }
  283. start = ktime_get();
  284. ret = dev->tx_ir(dev, txbuf, count);
  285. if (ret < 0)
  286. goto out_kfree;
  287. kfree(txbuf);
  288. kfree(raw);
  289. mutex_unlock(&dev->lock);
  290. /*
  291. * The lircd gap calculation expects the write function to
  292. * wait for the actual IR signal to be transmitted before
  293. * returning.
  294. */
  295. towait = ktime_us_delta(ktime_add_us(start, duration),
  296. ktime_get());
  297. if (towait > 0) {
  298. set_current_state(TASK_INTERRUPTIBLE);
  299. schedule_timeout(usecs_to_jiffies(towait));
  300. }
  301. return n;
  302. out_kfree:
  303. kfree(txbuf);
  304. out_kfree_raw:
  305. kfree(raw);
  306. out_unlock:
  307. mutex_unlock(&dev->lock);
  308. return ret;
  309. }
  310. static long ir_lirc_ioctl(struct file *file, unsigned int cmd,
  311. unsigned long arg)
  312. {
  313. struct lirc_fh *fh = file->private_data;
  314. struct rc_dev *dev = fh->rc;
  315. u32 __user *argp = (u32 __user *)(arg);
  316. u32 val = 0;
  317. int ret;
  318. if (_IOC_DIR(cmd) & _IOC_WRITE) {
  319. ret = get_user(val, argp);
  320. if (ret)
  321. return ret;
  322. }
  323. ret = mutex_lock_interruptible(&dev->lock);
  324. if (ret)
  325. return ret;
  326. if (!dev->registered) {
  327. ret = -ENODEV;
  328. goto out;
  329. }
  330. switch (cmd) {
  331. case LIRC_GET_FEATURES:
  332. if (dev->driver_type == RC_DRIVER_SCANCODE)
  333. val |= LIRC_CAN_REC_SCANCODE;
  334. if (dev->driver_type == RC_DRIVER_IR_RAW) {
  335. val |= LIRC_CAN_REC_MODE2;
  336. if (dev->rx_resolution)
  337. val |= LIRC_CAN_GET_REC_RESOLUTION;
  338. }
  339. if (dev->tx_ir) {
  340. val |= LIRC_CAN_SEND_PULSE;
  341. if (dev->s_tx_mask)
  342. val |= LIRC_CAN_SET_TRANSMITTER_MASK;
  343. if (dev->s_tx_carrier)
  344. val |= LIRC_CAN_SET_SEND_CARRIER;
  345. if (dev->s_tx_duty_cycle)
  346. val |= LIRC_CAN_SET_SEND_DUTY_CYCLE;
  347. }
  348. if (dev->s_rx_carrier_range)
  349. val |= LIRC_CAN_SET_REC_CARRIER |
  350. LIRC_CAN_SET_REC_CARRIER_RANGE;
  351. if (dev->s_learning_mode)
  352. val |= LIRC_CAN_USE_WIDEBAND_RECEIVER;
  353. if (dev->s_carrier_report)
  354. val |= LIRC_CAN_MEASURE_CARRIER;
  355. if (dev->max_timeout)
  356. val |= LIRC_CAN_SET_REC_TIMEOUT;
  357. break;
  358. /* mode support */
  359. case LIRC_GET_REC_MODE:
  360. if (dev->driver_type == RC_DRIVER_IR_RAW_TX)
  361. ret = -ENOTTY;
  362. else
  363. val = fh->rec_mode;
  364. break;
  365. case LIRC_SET_REC_MODE:
  366. switch (dev->driver_type) {
  367. case RC_DRIVER_IR_RAW_TX:
  368. ret = -ENOTTY;
  369. break;
  370. case RC_DRIVER_SCANCODE:
  371. if (val != LIRC_MODE_SCANCODE)
  372. ret = -EINVAL;
  373. break;
  374. case RC_DRIVER_IR_RAW:
  375. if (!(val == LIRC_MODE_MODE2 ||
  376. val == LIRC_MODE_SCANCODE))
  377. ret = -EINVAL;
  378. break;
  379. }
  380. if (!ret)
  381. fh->rec_mode = val;
  382. break;
  383. case LIRC_GET_SEND_MODE:
  384. if (!dev->tx_ir)
  385. ret = -ENOTTY;
  386. else
  387. val = fh->send_mode;
  388. break;
  389. case LIRC_SET_SEND_MODE:
  390. if (!dev->tx_ir)
  391. ret = -ENOTTY;
  392. else if (!(val == LIRC_MODE_PULSE || val == LIRC_MODE_SCANCODE))
  393. ret = -EINVAL;
  394. else
  395. fh->send_mode = val;
  396. break;
  397. /* TX settings */
  398. case LIRC_SET_TRANSMITTER_MASK:
  399. if (!dev->s_tx_mask)
  400. ret = -ENOTTY;
  401. else
  402. ret = dev->s_tx_mask(dev, val);
  403. break;
  404. case LIRC_SET_SEND_CARRIER:
  405. if (!dev->s_tx_carrier)
  406. ret = -ENOTTY;
  407. else
  408. ret = dev->s_tx_carrier(dev, val);
  409. break;
  410. case LIRC_SET_SEND_DUTY_CYCLE:
  411. if (!dev->s_tx_duty_cycle)
  412. ret = -ENOTTY;
  413. else if (val <= 0 || val >= 100)
  414. ret = -EINVAL;
  415. else
  416. ret = dev->s_tx_duty_cycle(dev, val);
  417. break;
  418. /* RX settings */
  419. case LIRC_SET_REC_CARRIER:
  420. if (!dev->s_rx_carrier_range)
  421. ret = -ENOTTY;
  422. else if (val <= 0)
  423. ret = -EINVAL;
  424. else
  425. ret = dev->s_rx_carrier_range(dev, fh->carrier_low,
  426. val);
  427. break;
  428. case LIRC_SET_REC_CARRIER_RANGE:
  429. if (!dev->s_rx_carrier_range)
  430. ret = -ENOTTY;
  431. else if (val <= 0)
  432. ret = -EINVAL;
  433. else
  434. fh->carrier_low = val;
  435. break;
  436. case LIRC_GET_REC_RESOLUTION:
  437. if (!dev->rx_resolution)
  438. ret = -ENOTTY;
  439. else
  440. val = dev->rx_resolution / 1000;
  441. break;
  442. case LIRC_SET_WIDEBAND_RECEIVER:
  443. if (!dev->s_learning_mode)
  444. ret = -ENOTTY;
  445. else
  446. ret = dev->s_learning_mode(dev, !!val);
  447. break;
  448. case LIRC_SET_MEASURE_CARRIER_MODE:
  449. if (!dev->s_carrier_report)
  450. ret = -ENOTTY;
  451. else
  452. ret = dev->s_carrier_report(dev, !!val);
  453. break;
  454. /* Generic timeout support */
  455. case LIRC_GET_MIN_TIMEOUT:
  456. if (!dev->max_timeout)
  457. ret = -ENOTTY;
  458. else
  459. val = DIV_ROUND_UP(dev->min_timeout, 1000);
  460. break;
  461. case LIRC_GET_MAX_TIMEOUT:
  462. if (!dev->max_timeout)
  463. ret = -ENOTTY;
  464. else
  465. val = dev->max_timeout / 1000;
  466. break;
  467. case LIRC_SET_REC_TIMEOUT:
  468. if (!dev->max_timeout) {
  469. ret = -ENOTTY;
  470. } else if (val > U32_MAX / 1000) {
  471. /* Check for multiply overflow */
  472. ret = -EINVAL;
  473. } else {
  474. u32 tmp = val * 1000;
  475. if (tmp < dev->min_timeout || tmp > dev->max_timeout)
  476. ret = -EINVAL;
  477. else if (dev->s_timeout)
  478. ret = dev->s_timeout(dev, tmp);
  479. else
  480. dev->timeout = tmp;
  481. }
  482. break;
  483. case LIRC_SET_REC_TIMEOUT_REPORTS:
  484. if (!dev->timeout)
  485. ret = -ENOTTY;
  486. else
  487. fh->send_timeout_reports = !!val;
  488. break;
  489. default:
  490. ret = -ENOTTY;
  491. }
  492. if (!ret && _IOC_DIR(cmd) & _IOC_READ)
  493. ret = put_user(val, argp);
  494. out:
  495. mutex_unlock(&dev->lock);
  496. return ret;
  497. }
  498. static __poll_t ir_lirc_poll(struct file *file, struct poll_table_struct *wait)
  499. {
  500. struct lirc_fh *fh = file->private_data;
  501. struct rc_dev *rcdev = fh->rc;
  502. __poll_t events = 0;
  503. poll_wait(file, &fh->wait_poll, wait);
  504. if (!rcdev->registered) {
  505. events = EPOLLHUP | EPOLLERR;
  506. } else if (rcdev->driver_type != RC_DRIVER_IR_RAW_TX) {
  507. if (fh->rec_mode == LIRC_MODE_SCANCODE &&
  508. !kfifo_is_empty(&fh->scancodes))
  509. events = EPOLLIN | EPOLLRDNORM;
  510. if (fh->rec_mode == LIRC_MODE_MODE2 &&
  511. !kfifo_is_empty(&fh->rawir))
  512. events = EPOLLIN | EPOLLRDNORM;
  513. }
  514. return events;
  515. }
  516. static ssize_t ir_lirc_read_mode2(struct file *file, char __user *buffer,
  517. size_t length)
  518. {
  519. struct lirc_fh *fh = file->private_data;
  520. struct rc_dev *rcdev = fh->rc;
  521. unsigned int copied;
  522. int ret;
  523. if (length < sizeof(unsigned int) || length % sizeof(unsigned int))
  524. return -EINVAL;
  525. do {
  526. if (kfifo_is_empty(&fh->rawir)) {
  527. if (file->f_flags & O_NONBLOCK)
  528. return -EAGAIN;
  529. ret = wait_event_interruptible(fh->wait_poll,
  530. !kfifo_is_empty(&fh->rawir) ||
  531. !rcdev->registered);
  532. if (ret)
  533. return ret;
  534. }
  535. if (!rcdev->registered)
  536. return -ENODEV;
  537. ret = mutex_lock_interruptible(&rcdev->lock);
  538. if (ret)
  539. return ret;
  540. ret = kfifo_to_user(&fh->rawir, buffer, length, &copied);
  541. mutex_unlock(&rcdev->lock);
  542. if (ret)
  543. return ret;
  544. } while (copied == 0);
  545. return copied;
  546. }
  547. static ssize_t ir_lirc_read_scancode(struct file *file, char __user *buffer,
  548. size_t length)
  549. {
  550. struct lirc_fh *fh = file->private_data;
  551. struct rc_dev *rcdev = fh->rc;
  552. unsigned int copied;
  553. int ret;
  554. if (length < sizeof(struct lirc_scancode) ||
  555. length % sizeof(struct lirc_scancode))
  556. return -EINVAL;
  557. do {
  558. if (kfifo_is_empty(&fh->scancodes)) {
  559. if (file->f_flags & O_NONBLOCK)
  560. return -EAGAIN;
  561. ret = wait_event_interruptible(fh->wait_poll,
  562. !kfifo_is_empty(&fh->scancodes) ||
  563. !rcdev->registered);
  564. if (ret)
  565. return ret;
  566. }
  567. if (!rcdev->registered)
  568. return -ENODEV;
  569. ret = mutex_lock_interruptible(&rcdev->lock);
  570. if (ret)
  571. return ret;
  572. ret = kfifo_to_user(&fh->scancodes, buffer, length, &copied);
  573. mutex_unlock(&rcdev->lock);
  574. if (ret)
  575. return ret;
  576. } while (copied == 0);
  577. return copied;
  578. }
  579. static ssize_t ir_lirc_read(struct file *file, char __user *buffer,
  580. size_t length, loff_t *ppos)
  581. {
  582. struct lirc_fh *fh = file->private_data;
  583. struct rc_dev *rcdev = fh->rc;
  584. if (rcdev->driver_type == RC_DRIVER_IR_RAW_TX)
  585. return -EINVAL;
  586. if (!rcdev->registered)
  587. return -ENODEV;
  588. if (fh->rec_mode == LIRC_MODE_MODE2)
  589. return ir_lirc_read_mode2(file, buffer, length);
  590. else /* LIRC_MODE_SCANCODE */
  591. return ir_lirc_read_scancode(file, buffer, length);
  592. }
  593. static const struct file_operations lirc_fops = {
  594. .owner = THIS_MODULE,
  595. .write = ir_lirc_transmit_ir,
  596. .unlocked_ioctl = ir_lirc_ioctl,
  597. #ifdef CONFIG_COMPAT
  598. .compat_ioctl = ir_lirc_ioctl,
  599. #endif
  600. .read = ir_lirc_read,
  601. .poll = ir_lirc_poll,
  602. .open = ir_lirc_open,
  603. .release = ir_lirc_close,
  604. .llseek = no_llseek,
  605. };
  606. static void lirc_release_device(struct device *ld)
  607. {
  608. struct rc_dev *rcdev = container_of(ld, struct rc_dev, lirc_dev);
  609. put_device(&rcdev->dev);
  610. }
  611. int ir_lirc_register(struct rc_dev *dev)
  612. {
  613. const char *rx_type, *tx_type;
  614. int err, minor;
  615. minor = ida_simple_get(&lirc_ida, 0, RC_DEV_MAX, GFP_KERNEL);
  616. if (minor < 0)
  617. return minor;
  618. device_initialize(&dev->lirc_dev);
  619. dev->lirc_dev.class = lirc_class;
  620. dev->lirc_dev.parent = &dev->dev;
  621. dev->lirc_dev.release = lirc_release_device;
  622. dev->lirc_dev.devt = MKDEV(MAJOR(lirc_base_dev), minor);
  623. dev_set_name(&dev->lirc_dev, "lirc%d", minor);
  624. INIT_LIST_HEAD(&dev->lirc_fh);
  625. spin_lock_init(&dev->lirc_fh_lock);
  626. cdev_init(&dev->lirc_cdev, &lirc_fops);
  627. err = cdev_device_add(&dev->lirc_cdev, &dev->lirc_dev);
  628. if (err)
  629. goto out_ida;
  630. get_device(&dev->dev);
  631. switch (dev->driver_type) {
  632. case RC_DRIVER_SCANCODE:
  633. rx_type = "scancode";
  634. break;
  635. case RC_DRIVER_IR_RAW:
  636. rx_type = "raw IR";
  637. break;
  638. default:
  639. rx_type = "no";
  640. break;
  641. }
  642. if (dev->tx_ir)
  643. tx_type = "raw IR";
  644. else
  645. tx_type = "no";
  646. dev_info(&dev->dev, "lirc_dev: driver %s registered at minor = %d, %s receiver, %s transmitter",
  647. dev->driver_name, minor, rx_type, tx_type);
  648. return 0;
  649. out_ida:
  650. ida_simple_remove(&lirc_ida, minor);
  651. return err;
  652. }
  653. void ir_lirc_unregister(struct rc_dev *dev)
  654. {
  655. unsigned long flags;
  656. struct lirc_fh *fh;
  657. dev_dbg(&dev->dev, "lirc_dev: driver %s unregistered from minor = %d\n",
  658. dev->driver_name, MINOR(dev->lirc_dev.devt));
  659. spin_lock_irqsave(&dev->lirc_fh_lock, flags);
  660. list_for_each_entry(fh, &dev->lirc_fh, list)
  661. wake_up_poll(&fh->wait_poll, EPOLLHUP | EPOLLERR);
  662. spin_unlock_irqrestore(&dev->lirc_fh_lock, flags);
  663. cdev_device_del(&dev->lirc_cdev, &dev->lirc_dev);
  664. ida_simple_remove(&lirc_ida, MINOR(dev->lirc_dev.devt));
  665. }
  666. int __init lirc_dev_init(void)
  667. {
  668. int retval;
  669. lirc_class = class_create(THIS_MODULE, "lirc");
  670. if (IS_ERR(lirc_class)) {
  671. pr_err("class_create failed\n");
  672. return PTR_ERR(lirc_class);
  673. }
  674. retval = alloc_chrdev_region(&lirc_base_dev, 0, RC_DEV_MAX,
  675. "BaseRemoteCtl");
  676. if (retval) {
  677. class_destroy(lirc_class);
  678. pr_err("alloc_chrdev_region failed\n");
  679. return retval;
  680. }
  681. pr_debug("IR Remote Control driver registered, major %d\n",
  682. MAJOR(lirc_base_dev));
  683. return 0;
  684. }
  685. void __exit lirc_dev_exit(void)
  686. {
  687. class_destroy(lirc_class);
  688. unregister_chrdev_region(lirc_base_dev, RC_DEV_MAX);
  689. }
  690. MODULE_ALIAS("lirc_dev");