user-rc-input.c 6.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252
  1. /* Copyright (c) 2012, The Linux Foundation. All rights reserved.
  2. *
  3. * This program is free software; you can redistribute it and/or modify
  4. * it under the terms of the GNU General Public License version 2 and
  5. * only version 2 as published by the Free Software Foundation.
  6. *
  7. * This program is distributed in the hope that it will be useful,
  8. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  9. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  10. * GNU General Public License for more details.
  11. */
  12. #include <linux/module.h>
  13. #include <linux/kernel.h>
  14. #include <linux/errno.h>
  15. #include <linux/ioctl.h>
  16. #include <linux/fs.h>
  17. #include <linux/poll.h>
  18. #include <linux/platform_device.h>
  19. #include <linux/device.h>
  20. #include <linux/cdev.h>
  21. #include <linux/slab.h>
  22. #include <media/rc-core.h>
  23. #include <media/user-rc-input.h>
  24. #define MAX_RC_DEVICES 1
  25. #define USER_RC_INPUT_DEV_NAME "user-rc-input"
  26. #define USER_RC_INPUT_DRV_NAME "rc-user-input"
  27. struct user_rc_input_dev {
  28. struct cdev rc_input_cdev;
  29. struct class *rc_input_class;
  30. struct device *rc_input_dev;
  31. struct rc_dev *rcdev;
  32. dev_t rc_input_base_dev;
  33. struct device *dev;
  34. int in_use;
  35. };
  36. static int user_rc_input_open(struct inode *inode, struct file *file)
  37. {
  38. struct cdev *input_cdev = inode->i_cdev;
  39. struct user_rc_input_dev *input_dev =
  40. container_of(input_cdev, struct user_rc_input_dev, rc_input_cdev);
  41. if (input_dev->in_use) {
  42. dev_err(input_dev->dev,
  43. "Device is already open..only one instance is allowed\n");
  44. return -EBUSY;
  45. }
  46. input_dev->in_use++;
  47. file->private_data = input_dev;
  48. return 0;
  49. }
  50. static int user_rc_input_release(struct inode *inode, struct file *file)
  51. {
  52. struct user_rc_input_dev *input_dev = file->private_data;
  53. input_dev->in_use--;
  54. return 0;
  55. }
  56. static ssize_t user_rc_input_write(struct file *file, const char __user *buffer,
  57. size_t count, loff_t *ppos)
  58. {
  59. int ret;
  60. struct user_rc_input_dev *input_dev = file->private_data;
  61. __u8 *buf;
  62. buf = kmalloc(count * sizeof(__u8), GFP_KERNEL);
  63. if (!buf) {
  64. dev_err(input_dev->dev,
  65. "kmalloc failed...Insufficient memory\n");
  66. ret = -ENOMEM;
  67. goto out;
  68. }
  69. if (copy_from_user(buf, buffer, count)) {
  70. dev_err(input_dev->dev, "Copy from user failed\n");
  71. ret = -EFAULT;
  72. goto out_free;
  73. }
  74. switch (buf[0]) {
  75. case USER_CONTROL_PRESSED:
  76. dev_dbg(input_dev->dev, "user controlled"
  77. " pressed 0x%x\n", buf[1]);
  78. rc_keydown(input_dev->rcdev, buf[1], 0);
  79. break;
  80. case USER_CONTROL_REPEATED:
  81. dev_dbg(input_dev->dev, "user controlled"
  82. " repeated 0x%x\n", buf[1]);
  83. rc_repeat(input_dev->rcdev);
  84. break;
  85. case USER_CONTROL_RELEASED:
  86. dev_dbg(input_dev->dev, "user controlled"
  87. " released 0x%x\n", buf[1]);
  88. rc_keyup(input_dev->rcdev);
  89. break;
  90. }
  91. out_free:
  92. kfree(buf);
  93. out:
  94. return ret;
  95. }
  96. const struct file_operations fops = {
  97. .owner = THIS_MODULE,
  98. .open = user_rc_input_open,
  99. .write = user_rc_input_write,
  100. .release = user_rc_input_release,
  101. };
  102. static int __devinit user_rc_input_probe(struct platform_device *pdev)
  103. {
  104. struct user_rc_input_dev *user_rc_dev;
  105. struct rc_dev *rcdev;
  106. int retval;
  107. user_rc_dev = kzalloc(sizeof(struct user_rc_input_dev), GFP_KERNEL);
  108. if (!user_rc_dev)
  109. return -ENOMEM;
  110. user_rc_dev->rc_input_class = class_create(THIS_MODULE,
  111. "user-rc-input-loopback");
  112. if (IS_ERR(user_rc_dev->rc_input_class)) {
  113. retval = PTR_ERR(user_rc_dev->rc_input_class);
  114. goto err;
  115. }
  116. retval = alloc_chrdev_region(&user_rc_dev->rc_input_base_dev, 0,
  117. MAX_RC_DEVICES, USER_RC_INPUT_DEV_NAME);
  118. if (retval) {
  119. dev_err(&pdev->dev,
  120. "alloc_chrdev_region failed\n");
  121. goto alloc_chrdev_err;
  122. }
  123. dev_info(&pdev->dev, "User space report key event input "
  124. "loopback driver registered, "
  125. "major %d\n", MAJOR(user_rc_dev->rc_input_base_dev));
  126. cdev_init(&user_rc_dev->rc_input_cdev, &fops);
  127. retval = cdev_add(&user_rc_dev->rc_input_cdev,
  128. user_rc_dev->rc_input_base_dev,
  129. MAX_RC_DEVICES);
  130. if (retval) {
  131. dev_err(&pdev->dev, "cdev_add failed\n");
  132. goto cdev_add_err;
  133. }
  134. user_rc_dev->rc_input_dev =
  135. device_create(user_rc_dev->rc_input_class,
  136. NULL,
  137. MKDEV(MAJOR(user_rc_dev->rc_input_base_dev),
  138. 0), NULL, "user-rc-input-dev%d", 0);
  139. if (IS_ERR(user_rc_dev->rc_input_dev)) {
  140. retval = PTR_ERR(user_rc_dev->rc_input_dev);
  141. dev_err(&pdev->dev, "device_create failed\n");
  142. goto device_create_err;
  143. }
  144. rcdev = rc_allocate_device();
  145. if (!rcdev) {
  146. dev_err(&pdev->dev, "failed to allocate rc device");
  147. retval = -ENOMEM;
  148. goto err_allocate_device;
  149. }
  150. rcdev->driver_type = RC_DRIVER_SCANCODE;
  151. rcdev->allowed_protos = RC_TYPE_OTHER;
  152. rcdev->input_name = USER_RC_INPUT_DEV_NAME;
  153. rcdev->input_id.bustype = BUS_HOST;
  154. rcdev->driver_name = USER_RC_INPUT_DRV_NAME;
  155. rcdev->map_name = RC_MAP_UE_RF4CE;
  156. retval = rc_register_device(rcdev);
  157. if (retval < 0) {
  158. dev_err(&pdev->dev, "failed to register rc device\n");
  159. goto rc_register_err;
  160. }
  161. user_rc_dev->rcdev = rcdev;
  162. user_rc_dev->dev = &pdev->dev;
  163. platform_set_drvdata(pdev, user_rc_dev);
  164. user_rc_dev->in_use = 0;
  165. return 0;
  166. rc_register_err:
  167. rc_free_device(rcdev);
  168. err_allocate_device:
  169. device_destroy(user_rc_dev->rc_input_class,
  170. MKDEV(MAJOR(user_rc_dev->rc_input_base_dev), 0));
  171. cdev_add_err:
  172. unregister_chrdev_region(user_rc_dev->rc_input_base_dev,
  173. MAX_RC_DEVICES);
  174. device_create_err:
  175. cdev_del(&user_rc_dev->rc_input_cdev);
  176. alloc_chrdev_err:
  177. class_destroy(user_rc_dev->rc_input_class);
  178. err:
  179. kfree(user_rc_dev);
  180. return retval;
  181. }
  182. static int __devexit user_rc_input_remove(struct platform_device *pdev)
  183. {
  184. struct user_rc_input_dev *user_rc_dev = platform_get_drvdata(pdev);
  185. platform_set_drvdata(pdev, NULL);
  186. rc_free_device(user_rc_dev->rcdev);
  187. device_destroy(user_rc_dev->rc_input_class,
  188. MKDEV(MAJOR(user_rc_dev->rc_input_base_dev), 0));
  189. unregister_chrdev_region(user_rc_dev->rc_input_base_dev,
  190. MAX_RC_DEVICES);
  191. cdev_del(&user_rc_dev->rc_input_cdev);
  192. class_destroy(user_rc_dev->rc_input_class);
  193. kfree(user_rc_dev);
  194. return 0;
  195. }
  196. static struct platform_driver user_rc_input_driver = {
  197. .probe = user_rc_input_probe,
  198. .remove = __devexit_p(user_rc_input_remove),
  199. .driver = {
  200. .name = USER_RC_INPUT_DRV_NAME,
  201. .owner = THIS_MODULE,
  202. },
  203. };
  204. static int __init user_rc_input_init(void)
  205. {
  206. return platform_driver_register(&user_rc_input_driver);
  207. }
  208. module_init(user_rc_input_init);
  209. static void __exit user_rc_input_exit(void)
  210. {
  211. platform_driver_unregister(&user_rc_input_driver);
  212. }
  213. module_exit(user_rc_input_exit);
  214. MODULE_DESCRIPTION("User RC Input driver");
  215. MODULE_LICENSE("GPL v2");