serio.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909
  1. /*
  2. * The Serio abstraction module
  3. *
  4. * Copyright (c) 1999-2004 Vojtech Pavlik
  5. * Copyright (c) 2004 Dmitry Torokhov
  6. * Copyright (c) 2003 Daniele Bellucci
  7. */
  8. /*
  9. * This program is free software; you can redistribute it and/or modify
  10. * it under the terms of the GNU General Public License as published by
  11. * the Free Software Foundation; either version 2 of the License, or
  12. * (at your option) any later version.
  13. *
  14. * This program is distributed in the hope that it will be useful,
  15. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  16. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  17. * GNU General Public License for more details.
  18. *
  19. * You should have received a copy of the GNU General Public License
  20. * along with this program; if not, write to the Free Software
  21. * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
  22. *
  23. * Should you need to contact me, the author, you can do so either by
  24. * e-mail - mail your message to <vojtech@ucw.cz>, or by paper mail:
  25. * Vojtech Pavlik, Simunkova 1594, Prague 8, 182 00 Czech Republic
  26. */
  27. #include <linux/stddef.h>
  28. #include <linux/module.h>
  29. #include <linux/serio.h>
  30. #include <linux/errno.h>
  31. #include <linux/wait.h>
  32. #include <linux/sched.h>
  33. #include <linux/slab.h>
  34. #include <linux/kthread.h>
  35. MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>");
  36. MODULE_DESCRIPTION("Serio abstraction core");
  37. MODULE_LICENSE("GPL");
  38. EXPORT_SYMBOL(serio_interrupt);
  39. EXPORT_SYMBOL(__serio_register_port);
  40. EXPORT_SYMBOL(serio_unregister_port);
  41. EXPORT_SYMBOL(serio_unregister_child_port);
  42. EXPORT_SYMBOL(__serio_unregister_port_delayed);
  43. EXPORT_SYMBOL(__serio_register_driver);
  44. EXPORT_SYMBOL(serio_unregister_driver);
  45. EXPORT_SYMBOL(serio_open);
  46. EXPORT_SYMBOL(serio_close);
  47. EXPORT_SYMBOL(serio_rescan);
  48. EXPORT_SYMBOL(serio_reconnect);
  49. /*
  50. * serio_sem protects entire serio subsystem and is taken every time
  51. * serio port or driver registrered or unregistered.
  52. */
  53. static DECLARE_MUTEX(serio_sem);
  54. static LIST_HEAD(serio_list);
  55. static struct bus_type serio_bus = {
  56. .name = "serio",
  57. };
  58. static void serio_add_port(struct serio *serio);
  59. static void serio_destroy_port(struct serio *serio);
  60. static void serio_reconnect_port(struct serio *serio);
  61. static void serio_disconnect_port(struct serio *serio);
  62. static int serio_connect_driver(struct serio *serio, struct serio_driver *drv)
  63. {
  64. int retval;
  65. down(&serio->drv_sem);
  66. retval = drv->connect(serio, drv);
  67. up(&serio->drv_sem);
  68. return retval;
  69. }
  70. static int serio_reconnect_driver(struct serio *serio)
  71. {
  72. int retval = -1;
  73. down(&serio->drv_sem);
  74. if (serio->drv && serio->drv->reconnect)
  75. retval = serio->drv->reconnect(serio);
  76. up(&serio->drv_sem);
  77. return retval;
  78. }
  79. static void serio_disconnect_driver(struct serio *serio)
  80. {
  81. down(&serio->drv_sem);
  82. if (serio->drv)
  83. serio->drv->disconnect(serio);
  84. up(&serio->drv_sem);
  85. }
  86. static int serio_match_port(const struct serio_device_id *ids, struct serio *serio)
  87. {
  88. while (ids->type || ids->proto) {
  89. if ((ids->type == SERIO_ANY || ids->type == serio->id.type) &&
  90. (ids->proto == SERIO_ANY || ids->proto == serio->id.proto) &&
  91. (ids->extra == SERIO_ANY || ids->extra == serio->id.extra) &&
  92. (ids->id == SERIO_ANY || ids->id == serio->id.id))
  93. return 1;
  94. ids++;
  95. }
  96. return 0;
  97. }
  98. /*
  99. * Basic serio -> driver core mappings
  100. */
  101. static void serio_bind_driver(struct serio *serio, struct serio_driver *drv)
  102. {
  103. down_write(&serio_bus.subsys.rwsem);
  104. if (serio_match_port(drv->id_table, serio)) {
  105. serio->dev.driver = &drv->driver;
  106. if (serio_connect_driver(serio, drv)) {
  107. serio->dev.driver = NULL;
  108. goto out;
  109. }
  110. device_bind_driver(&serio->dev);
  111. }
  112. out:
  113. up_write(&serio_bus.subsys.rwsem);
  114. }
  115. static void serio_release_driver(struct serio *serio)
  116. {
  117. down_write(&serio_bus.subsys.rwsem);
  118. device_release_driver(&serio->dev);
  119. up_write(&serio_bus.subsys.rwsem);
  120. }
  121. static void serio_find_driver(struct serio *serio)
  122. {
  123. down_write(&serio_bus.subsys.rwsem);
  124. device_attach(&serio->dev);
  125. up_write(&serio_bus.subsys.rwsem);
  126. }
  127. /*
  128. * Serio event processing.
  129. */
  130. enum serio_event_type {
  131. SERIO_RESCAN,
  132. SERIO_RECONNECT,
  133. SERIO_REGISTER_PORT,
  134. SERIO_UNREGISTER_PORT,
  135. SERIO_REGISTER_DRIVER,
  136. };
  137. struct serio_event {
  138. enum serio_event_type type;
  139. void *object;
  140. struct module *owner;
  141. struct list_head node;
  142. };
  143. static DEFINE_SPINLOCK(serio_event_lock); /* protects serio_event_list */
  144. static LIST_HEAD(serio_event_list);
  145. static DECLARE_WAIT_QUEUE_HEAD(serio_wait);
  146. static struct task_struct *serio_task;
  147. static void serio_queue_event(void *object, struct module *owner,
  148. enum serio_event_type event_type)
  149. {
  150. unsigned long flags;
  151. struct serio_event *event;
  152. spin_lock_irqsave(&serio_event_lock, flags);
  153. /*
  154. * Scan event list for the other events for the same serio port,
  155. * starting with the most recent one. If event is the same we
  156. * do not need add new one. If event is of different type we
  157. * need to add this event and should not look further because
  158. * we need to preseve sequence of distinct events.
  159. */
  160. list_for_each_entry_reverse(event, &serio_event_list, node) {
  161. if (event->object == object) {
  162. if (event->type == event_type)
  163. goto out;
  164. break;
  165. }
  166. }
  167. if ((event = kmalloc(sizeof(struct serio_event), GFP_ATOMIC))) {
  168. if (!try_module_get(owner)) {
  169. printk(KERN_WARNING "serio: Can't get module reference, dropping event %d\n", event_type);
  170. goto out;
  171. }
  172. event->type = event_type;
  173. event->object = object;
  174. event->owner = owner;
  175. list_add_tail(&event->node, &serio_event_list);
  176. wake_up(&serio_wait);
  177. } else {
  178. printk(KERN_ERR "serio: Not enough memory to queue event %d\n", event_type);
  179. }
  180. out:
  181. spin_unlock_irqrestore(&serio_event_lock, flags);
  182. }
  183. static void serio_free_event(struct serio_event *event)
  184. {
  185. module_put(event->owner);
  186. kfree(event);
  187. }
  188. static void serio_remove_duplicate_events(struct serio_event *event)
  189. {
  190. struct list_head *node, *next;
  191. struct serio_event *e;
  192. unsigned long flags;
  193. spin_lock_irqsave(&serio_event_lock, flags);
  194. list_for_each_safe(node, next, &serio_event_list) {
  195. e = list_entry(node, struct serio_event, node);
  196. if (event->object == e->object) {
  197. /*
  198. * If this event is of different type we should not
  199. * look further - we only suppress duplicate events
  200. * that were sent back-to-back.
  201. */
  202. if (event->type != e->type)
  203. break;
  204. list_del_init(node);
  205. serio_free_event(e);
  206. }
  207. }
  208. spin_unlock_irqrestore(&serio_event_lock, flags);
  209. }
  210. static struct serio_event *serio_get_event(void)
  211. {
  212. struct serio_event *event;
  213. struct list_head *node;
  214. unsigned long flags;
  215. spin_lock_irqsave(&serio_event_lock, flags);
  216. if (list_empty(&serio_event_list)) {
  217. spin_unlock_irqrestore(&serio_event_lock, flags);
  218. return NULL;
  219. }
  220. node = serio_event_list.next;
  221. event = list_entry(node, struct serio_event, node);
  222. list_del_init(node);
  223. spin_unlock_irqrestore(&serio_event_lock, flags);
  224. return event;
  225. }
  226. static void serio_handle_events(void)
  227. {
  228. struct serio_event *event;
  229. struct serio_driver *serio_drv;
  230. down(&serio_sem);
  231. while ((event = serio_get_event())) {
  232. switch (event->type) {
  233. case SERIO_REGISTER_PORT:
  234. serio_add_port(event->object);
  235. break;
  236. case SERIO_UNREGISTER_PORT:
  237. serio_disconnect_port(event->object);
  238. serio_destroy_port(event->object);
  239. break;
  240. case SERIO_RECONNECT:
  241. serio_reconnect_port(event->object);
  242. break;
  243. case SERIO_RESCAN:
  244. serio_disconnect_port(event->object);
  245. serio_find_driver(event->object);
  246. break;
  247. case SERIO_REGISTER_DRIVER:
  248. serio_drv = event->object;
  249. driver_register(&serio_drv->driver);
  250. break;
  251. default:
  252. break;
  253. }
  254. serio_remove_duplicate_events(event);
  255. serio_free_event(event);
  256. }
  257. up(&serio_sem);
  258. }
  259. /*
  260. * Remove all events that have been submitted for a given serio port.
  261. */
  262. static void serio_remove_pending_events(struct serio *serio)
  263. {
  264. struct list_head *node, *next;
  265. struct serio_event *event;
  266. unsigned long flags;
  267. spin_lock_irqsave(&serio_event_lock, flags);
  268. list_for_each_safe(node, next, &serio_event_list) {
  269. event = list_entry(node, struct serio_event, node);
  270. if (event->object == serio) {
  271. list_del_init(node);
  272. serio_free_event(event);
  273. }
  274. }
  275. spin_unlock_irqrestore(&serio_event_lock, flags);
  276. }
  277. /*
  278. * Destroy child serio port (if any) that has not been fully registered yet.
  279. *
  280. * Note that we rely on the fact that port can have only one child and therefore
  281. * only one child registration request can be pending. Additionally, children
  282. * are registered by driver's connect() handler so there can't be a grandchild
  283. * pending registration together with a child.
  284. */
  285. static struct serio *serio_get_pending_child(struct serio *parent)
  286. {
  287. struct serio_event *event;
  288. struct serio *serio, *child = NULL;
  289. unsigned long flags;
  290. spin_lock_irqsave(&serio_event_lock, flags);
  291. list_for_each_entry(event, &serio_event_list, node) {
  292. if (event->type == SERIO_REGISTER_PORT) {
  293. serio = event->object;
  294. if (serio->parent == parent) {
  295. child = serio;
  296. break;
  297. }
  298. }
  299. }
  300. spin_unlock_irqrestore(&serio_event_lock, flags);
  301. return child;
  302. }
  303. static int serio_thread(void *nothing)
  304. {
  305. do {
  306. serio_handle_events();
  307. wait_event_interruptible(serio_wait,
  308. kthread_should_stop() || !list_empty(&serio_event_list));
  309. try_to_freeze();
  310. } while (!kthread_should_stop());
  311. printk(KERN_DEBUG "serio: kseriod exiting\n");
  312. return 0;
  313. }
  314. /*
  315. * Serio port operations
  316. */
  317. static ssize_t serio_show_description(struct device *dev, struct device_attribute *attr, char *buf)
  318. {
  319. struct serio *serio = to_serio_port(dev);
  320. return sprintf(buf, "%s\n", serio->name);
  321. }
  322. static ssize_t serio_show_id_type(struct device *dev, struct device_attribute *attr, char *buf)
  323. {
  324. struct serio *serio = to_serio_port(dev);
  325. return sprintf(buf, "%02x\n", serio->id.type);
  326. }
  327. static ssize_t serio_show_id_proto(struct device *dev, struct device_attribute *attr, char *buf)
  328. {
  329. struct serio *serio = to_serio_port(dev);
  330. return sprintf(buf, "%02x\n", serio->id.proto);
  331. }
  332. static ssize_t serio_show_id_id(struct device *dev, struct device_attribute *attr, char *buf)
  333. {
  334. struct serio *serio = to_serio_port(dev);
  335. return sprintf(buf, "%02x\n", serio->id.id);
  336. }
  337. static ssize_t serio_show_id_extra(struct device *dev, struct device_attribute *attr, char *buf)
  338. {
  339. struct serio *serio = to_serio_port(dev);
  340. return sprintf(buf, "%02x\n", serio->id.extra);
  341. }
  342. static DEVICE_ATTR(type, S_IRUGO, serio_show_id_type, NULL);
  343. static DEVICE_ATTR(proto, S_IRUGO, serio_show_id_proto, NULL);
  344. static DEVICE_ATTR(id, S_IRUGO, serio_show_id_id, NULL);
  345. static DEVICE_ATTR(extra, S_IRUGO, serio_show_id_extra, NULL);
  346. static struct attribute *serio_device_id_attrs[] = {
  347. &dev_attr_type.attr,
  348. &dev_attr_proto.attr,
  349. &dev_attr_id.attr,
  350. &dev_attr_extra.attr,
  351. NULL
  352. };
  353. static struct attribute_group serio_id_attr_group = {
  354. .name = "id",
  355. .attrs = serio_device_id_attrs,
  356. };
  357. static ssize_t serio_rebind_driver(struct device *dev, struct device_attribute *attr, const char *buf, size_t count)
  358. {
  359. struct serio *serio = to_serio_port(dev);
  360. struct device_driver *drv;
  361. int retval;
  362. retval = down_interruptible(&serio_sem);
  363. if (retval)
  364. return retval;
  365. retval = count;
  366. if (!strncmp(buf, "none", count)) {
  367. serio_disconnect_port(serio);
  368. } else if (!strncmp(buf, "reconnect", count)) {
  369. serio_reconnect_port(serio);
  370. } else if (!strncmp(buf, "rescan", count)) {
  371. serio_disconnect_port(serio);
  372. serio_find_driver(serio);
  373. } else if ((drv = driver_find(buf, &serio_bus)) != NULL) {
  374. serio_disconnect_port(serio);
  375. serio_bind_driver(serio, to_serio_driver(drv));
  376. put_driver(drv);
  377. } else {
  378. retval = -EINVAL;
  379. }
  380. up(&serio_sem);
  381. return retval;
  382. }
  383. static ssize_t serio_show_bind_mode(struct device *dev, struct device_attribute *attr, char *buf)
  384. {
  385. struct serio *serio = to_serio_port(dev);
  386. return sprintf(buf, "%s\n", serio->manual_bind ? "manual" : "auto");
  387. }
  388. static ssize_t serio_set_bind_mode(struct device *dev, struct device_attribute *attr, const char *buf, size_t count)
  389. {
  390. struct serio *serio = to_serio_port(dev);
  391. int retval;
  392. retval = count;
  393. if (!strncmp(buf, "manual", count)) {
  394. serio->manual_bind = 1;
  395. } else if (!strncmp(buf, "auto", count)) {
  396. serio->manual_bind = 0;
  397. } else {
  398. retval = -EINVAL;
  399. }
  400. return retval;
  401. }
  402. static struct device_attribute serio_device_attrs[] = {
  403. __ATTR(description, S_IRUGO, serio_show_description, NULL),
  404. __ATTR(drvctl, S_IWUSR, NULL, serio_rebind_driver),
  405. __ATTR(bind_mode, S_IWUSR | S_IRUGO, serio_show_bind_mode, serio_set_bind_mode),
  406. __ATTR_NULL
  407. };
  408. static void serio_release_port(struct device *dev)
  409. {
  410. struct serio *serio = to_serio_port(dev);
  411. kfree(serio);
  412. module_put(THIS_MODULE);
  413. }
  414. /*
  415. * Prepare serio port for registration.
  416. */
  417. static void serio_init_port(struct serio *serio)
  418. {
  419. static atomic_t serio_no = ATOMIC_INIT(0);
  420. __module_get(THIS_MODULE);
  421. spin_lock_init(&serio->lock);
  422. init_MUTEX(&serio->drv_sem);
  423. device_initialize(&serio->dev);
  424. snprintf(serio->dev.bus_id, sizeof(serio->dev.bus_id),
  425. "serio%ld", (long)atomic_inc_return(&serio_no) - 1);
  426. serio->dev.bus = &serio_bus;
  427. serio->dev.release = serio_release_port;
  428. if (serio->parent)
  429. serio->dev.parent = &serio->parent->dev;
  430. }
  431. /*
  432. * Complete serio port registration.
  433. * Driver core will attempt to find appropriate driver for the port.
  434. */
  435. static void serio_add_port(struct serio *serio)
  436. {
  437. if (serio->parent) {
  438. serio_pause_rx(serio->parent);
  439. serio->parent->child = serio;
  440. serio_continue_rx(serio->parent);
  441. }
  442. list_add_tail(&serio->node, &serio_list);
  443. if (serio->start)
  444. serio->start(serio);
  445. device_add(&serio->dev);
  446. sysfs_create_group(&serio->dev.kobj, &serio_id_attr_group);
  447. serio->registered = 1;
  448. }
  449. /*
  450. * serio_destroy_port() completes deregistration process and removes
  451. * port from the system
  452. */
  453. static void serio_destroy_port(struct serio *serio)
  454. {
  455. struct serio *child;
  456. child = serio_get_pending_child(serio);
  457. if (child) {
  458. serio_remove_pending_events(child);
  459. put_device(&child->dev);
  460. }
  461. if (serio->stop)
  462. serio->stop(serio);
  463. if (serio->parent) {
  464. serio_pause_rx(serio->parent);
  465. serio->parent->child = NULL;
  466. serio_continue_rx(serio->parent);
  467. serio->parent = NULL;
  468. }
  469. if (serio->registered) {
  470. sysfs_remove_group(&serio->dev.kobj, &serio_id_attr_group);
  471. device_del(&serio->dev);
  472. list_del_init(&serio->node);
  473. serio->registered = 0;
  474. }
  475. serio_remove_pending_events(serio);
  476. put_device(&serio->dev);
  477. }
  478. /*
  479. * Reconnect serio port and all its children (re-initialize attached devices)
  480. */
  481. static void serio_reconnect_port(struct serio *serio)
  482. {
  483. do {
  484. if (serio_reconnect_driver(serio)) {
  485. serio_disconnect_port(serio);
  486. serio_find_driver(serio);
  487. /* Ok, old children are now gone, we are done */
  488. break;
  489. }
  490. serio = serio->child;
  491. } while (serio);
  492. }
  493. /*
  494. * serio_disconnect_port() unbinds a port from its driver. As a side effect
  495. * all child ports are unbound and destroyed.
  496. */
  497. static void serio_disconnect_port(struct serio *serio)
  498. {
  499. struct serio *s, *parent;
  500. if (serio->child) {
  501. /*
  502. * Children ports should be disconnected and destroyed
  503. * first, staring with the leaf one, since we don't want
  504. * to do recursion
  505. */
  506. for (s = serio; s->child; s = s->child)
  507. /* empty */;
  508. do {
  509. parent = s->parent;
  510. serio_release_driver(s);
  511. serio_destroy_port(s);
  512. } while ((s = parent) != serio);
  513. }
  514. /*
  515. * Ok, no children left, now disconnect this port
  516. */
  517. serio_release_driver(serio);
  518. }
  519. void serio_rescan(struct serio *serio)
  520. {
  521. serio_queue_event(serio, NULL, SERIO_RESCAN);
  522. }
  523. void serio_reconnect(struct serio *serio)
  524. {
  525. serio_queue_event(serio, NULL, SERIO_RECONNECT);
  526. }
  527. /*
  528. * Submits register request to kseriod for subsequent execution.
  529. * Note that port registration is always asynchronous.
  530. */
  531. void __serio_register_port(struct serio *serio, struct module *owner)
  532. {
  533. serio_init_port(serio);
  534. serio_queue_event(serio, owner, SERIO_REGISTER_PORT);
  535. }
  536. /*
  537. * Synchronously unregisters serio port.
  538. */
  539. void serio_unregister_port(struct serio *serio)
  540. {
  541. down(&serio_sem);
  542. serio_disconnect_port(serio);
  543. serio_destroy_port(serio);
  544. up(&serio_sem);
  545. }
  546. /*
  547. * Safely unregisters child port if one is present.
  548. */
  549. void serio_unregister_child_port(struct serio *serio)
  550. {
  551. down(&serio_sem);
  552. if (serio->child) {
  553. serio_disconnect_port(serio->child);
  554. serio_destroy_port(serio->child);
  555. }
  556. up(&serio_sem);
  557. }
  558. /*
  559. * Submits register request to kseriod for subsequent execution.
  560. * Can be used when it is not obvious whether the serio_sem is
  561. * taken or not and when delayed execution is feasible.
  562. */
  563. void __serio_unregister_port_delayed(struct serio *serio, struct module *owner)
  564. {
  565. serio_queue_event(serio, owner, SERIO_UNREGISTER_PORT);
  566. }
  567. /*
  568. * Serio driver operations
  569. */
  570. static ssize_t serio_driver_show_description(struct device_driver *drv, char *buf)
  571. {
  572. struct serio_driver *driver = to_serio_driver(drv);
  573. return sprintf(buf, "%s\n", driver->description ? driver->description : "(none)");
  574. }
  575. static ssize_t serio_driver_show_bind_mode(struct device_driver *drv, char *buf)
  576. {
  577. struct serio_driver *serio_drv = to_serio_driver(drv);
  578. return sprintf(buf, "%s\n", serio_drv->manual_bind ? "manual" : "auto");
  579. }
  580. static ssize_t serio_driver_set_bind_mode(struct device_driver *drv, const char *buf, size_t count)
  581. {
  582. struct serio_driver *serio_drv = to_serio_driver(drv);
  583. int retval;
  584. retval = count;
  585. if (!strncmp(buf, "manual", count)) {
  586. serio_drv->manual_bind = 1;
  587. } else if (!strncmp(buf, "auto", count)) {
  588. serio_drv->manual_bind = 0;
  589. } else {
  590. retval = -EINVAL;
  591. }
  592. return retval;
  593. }
  594. static struct driver_attribute serio_driver_attrs[] = {
  595. __ATTR(description, S_IRUGO, serio_driver_show_description, NULL),
  596. __ATTR(bind_mode, S_IWUSR | S_IRUGO,
  597. serio_driver_show_bind_mode, serio_driver_set_bind_mode),
  598. __ATTR_NULL
  599. };
  600. static int serio_driver_probe(struct device *dev)
  601. {
  602. struct serio *serio = to_serio_port(dev);
  603. struct serio_driver *drv = to_serio_driver(dev->driver);
  604. return serio_connect_driver(serio, drv);
  605. }
  606. static int serio_driver_remove(struct device *dev)
  607. {
  608. struct serio *serio = to_serio_port(dev);
  609. serio_disconnect_driver(serio);
  610. return 0;
  611. }
  612. void __serio_register_driver(struct serio_driver *drv, struct module *owner)
  613. {
  614. drv->driver.bus = &serio_bus;
  615. drv->driver.probe = serio_driver_probe;
  616. drv->driver.remove = serio_driver_remove;
  617. serio_queue_event(drv, owner, SERIO_REGISTER_DRIVER);
  618. }
  619. void serio_unregister_driver(struct serio_driver *drv)
  620. {
  621. struct serio *serio;
  622. down(&serio_sem);
  623. drv->manual_bind = 1; /* so serio_find_driver ignores it */
  624. start_over:
  625. list_for_each_entry(serio, &serio_list, node) {
  626. if (serio->drv == drv) {
  627. serio_disconnect_port(serio);
  628. serio_find_driver(serio);
  629. /* we could've deleted some ports, restart */
  630. goto start_over;
  631. }
  632. }
  633. driver_unregister(&drv->driver);
  634. up(&serio_sem);
  635. }
  636. static void serio_set_drv(struct serio *serio, struct serio_driver *drv)
  637. {
  638. serio_pause_rx(serio);
  639. serio->drv = drv;
  640. serio_continue_rx(serio);
  641. }
  642. static int serio_bus_match(struct device *dev, struct device_driver *drv)
  643. {
  644. struct serio *serio = to_serio_port(dev);
  645. struct serio_driver *serio_drv = to_serio_driver(drv);
  646. if (serio->manual_bind || serio_drv->manual_bind)
  647. return 0;
  648. return serio_match_port(serio_drv->id_table, serio);
  649. }
  650. #ifdef CONFIG_HOTPLUG
  651. #define PUT_ENVP(fmt, val) \
  652. do { \
  653. envp[i++] = buffer; \
  654. length += snprintf(buffer, buffer_size - length, fmt, val); \
  655. if (buffer_size - length <= 0 || i >= num_envp) \
  656. return -ENOMEM; \
  657. length++; \
  658. buffer += length; \
  659. } while (0)
  660. static int serio_hotplug(struct device *dev, char **envp, int num_envp, char *buffer, int buffer_size)
  661. {
  662. struct serio *serio;
  663. int i = 0;
  664. int length = 0;
  665. if (!dev)
  666. return -ENODEV;
  667. serio = to_serio_port(dev);
  668. PUT_ENVP("SERIO_TYPE=%02x", serio->id.type);
  669. PUT_ENVP("SERIO_PROTO=%02x", serio->id.proto);
  670. PUT_ENVP("SERIO_ID=%02x", serio->id.id);
  671. PUT_ENVP("SERIO_EXTRA=%02x", serio->id.extra);
  672. envp[i] = NULL;
  673. return 0;
  674. }
  675. #undef PUT_ENVP
  676. #else
  677. static int serio_hotplug(struct device *dev, char **envp, int num_envp, char *buffer, int buffer_size)
  678. {
  679. return -ENODEV;
  680. }
  681. #endif /* CONFIG_HOTPLUG */
  682. static int serio_resume(struct device *dev)
  683. {
  684. struct serio *serio = to_serio_port(dev);
  685. if (serio_reconnect_driver(serio)) {
  686. /*
  687. * Driver re-probing can take a while, so better let kseriod
  688. * deal with it.
  689. */
  690. serio_rescan(serio);
  691. }
  692. return 0;
  693. }
  694. /* called from serio_driver->connect/disconnect methods under serio_sem */
  695. int serio_open(struct serio *serio, struct serio_driver *drv)
  696. {
  697. serio_set_drv(serio, drv);
  698. if (serio->open && serio->open(serio)) {
  699. serio_set_drv(serio, NULL);
  700. return -1;
  701. }
  702. return 0;
  703. }
  704. /* called from serio_driver->connect/disconnect methods under serio_sem */
  705. void serio_close(struct serio *serio)
  706. {
  707. if (serio->close)
  708. serio->close(serio);
  709. serio_set_drv(serio, NULL);
  710. }
  711. irqreturn_t serio_interrupt(struct serio *serio,
  712. unsigned char data, unsigned int dfl, struct pt_regs *regs)
  713. {
  714. unsigned long flags;
  715. irqreturn_t ret = IRQ_NONE;
  716. spin_lock_irqsave(&serio->lock, flags);
  717. if (likely(serio->drv)) {
  718. ret = serio->drv->interrupt(serio, data, dfl, regs);
  719. } else if (!dfl && serio->registered) {
  720. serio_rescan(serio);
  721. ret = IRQ_HANDLED;
  722. }
  723. spin_unlock_irqrestore(&serio->lock, flags);
  724. return ret;
  725. }
  726. static int __init serio_init(void)
  727. {
  728. serio_task = kthread_run(serio_thread, NULL, "kseriod");
  729. if (IS_ERR(serio_task)) {
  730. printk(KERN_ERR "serio: Failed to start kseriod\n");
  731. return PTR_ERR(serio_task);
  732. }
  733. serio_bus.dev_attrs = serio_device_attrs;
  734. serio_bus.drv_attrs = serio_driver_attrs;
  735. serio_bus.match = serio_bus_match;
  736. serio_bus.hotplug = serio_hotplug;
  737. serio_bus.resume = serio_resume;
  738. bus_register(&serio_bus);
  739. return 0;
  740. }
  741. static void __exit serio_exit(void)
  742. {
  743. bus_unregister(&serio_bus);
  744. kthread_stop(serio_task);
  745. }
  746. module_init(serio_init);
  747. module_exit(serio_exit);