/* * $Id: serio.c,v 1.15 2002/01/22 21:12:03 vojtech Exp $ * * Copyright (c) 1999-2001 Vojtech Pavlik */ /* * The Serio abstraction module */ /* * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; either version 2 of the License, or * (at your option) any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA * * Should you need to contact me, the author, you can do so either by * e-mail - mail your message to , or by paper mail: * Vojtech Pavlik, Simunkova 1594, Prague 8, 182 00 Czech Republic * * Changes: * 20 Jul. 2003 Daniele Bellucci * Minor cleanups. */ #include #include #include #include #include #include #include #include #include #include MODULE_AUTHOR("Vojtech Pavlik "); MODULE_DESCRIPTION("Serio abstraction core"); MODULE_LICENSE("GPL"); EXPORT_SYMBOL(serio_interrupt); EXPORT_SYMBOL(serio_register_port); EXPORT_SYMBOL(serio_register_port_delayed); EXPORT_SYMBOL(__serio_register_port); EXPORT_SYMBOL(serio_unregister_port); EXPORT_SYMBOL(serio_unregister_port_delayed); EXPORT_SYMBOL(__serio_unregister_port); EXPORT_SYMBOL(serio_register_device); EXPORT_SYMBOL(serio_unregister_device); EXPORT_SYMBOL(serio_open); EXPORT_SYMBOL(serio_close); EXPORT_SYMBOL(serio_rescan); EXPORT_SYMBOL(serio_reconnect); struct serio_event { int type; struct serio *serio; struct list_head node; }; static DECLARE_MUTEX(serio_sem); static LIST_HEAD(serio_list); static LIST_HEAD(serio_dev_list); static LIST_HEAD(serio_event_list); static int serio_pid; static void serio_find_dev(struct serio *serio) { struct serio_dev *dev; list_for_each_entry(dev, &serio_dev_list, node) { if (serio->dev) break; if (dev->connect) dev->connect(serio, dev); } } #define SERIO_RESCAN 1 #define SERIO_RECONNECT 2 #define SERIO_REGISTER_PORT 3 #define SERIO_UNREGISTER_PORT 4 static DECLARE_WAIT_QUEUE_HEAD(serio_wait); static DECLARE_COMPLETION(serio_exited); static void serio_invalidate_pending_events(struct serio *serio) { struct serio_event *event; list_for_each_entry(event, &serio_event_list, node) if (event->serio == serio) event->serio = NULL; } void serio_handle_events(void) { struct list_head *node, *next; struct serio_event *event; list_for_each_safe(node, next, &serio_event_list) { event = container_of(node, struct serio_event, node); down(&serio_sem); if (event->serio == NULL) goto event_done; switch (event->type) { case SERIO_REGISTER_PORT : __serio_register_port(event->serio); break; case SERIO_UNREGISTER_PORT : __serio_unregister_port(event->serio); break; case SERIO_RECONNECT : if (event->serio->dev && event->serio->dev->reconnect) if (event->serio->dev->reconnect(event->serio) == 0) break; /* reconnect failed - fall through to rescan */ case SERIO_RESCAN : if (event->serio->dev && event->serio->dev->disconnect) event->serio->dev->disconnect(event->serio); serio_find_dev(event->serio); break; default: break; } event_done: up(&serio_sem); list_del_init(node); kfree(event); } } static int serio_thread(void *nothing) { lock_kernel(); daemonize("kseriod"); allow_signal(SIGTERM); do { serio_handle_events(); wait_event_interruptible(serio_wait, !list_empty(&serio_event_list)); if (current->flags & PF_FREEZE) refrigerator(PF_FREEZE); } while (!signal_pending(current)); printk(KERN_DEBUG "serio: kseriod exiting\n"); unlock_kernel(); complete_and_exit(&serio_exited, 0); } static void serio_queue_event(struct serio *serio, int event_type) { struct serio_event *event; if ((event = kmalloc(sizeof(struct serio_event), GFP_ATOMIC))) { event->type = event_type; event->serio = serio; list_add_tail(&event->node, &serio_event_list); wake_up(&serio_wait); } } void serio_rescan(struct serio *serio) { serio_queue_event(serio, SERIO_RESCAN); } void serio_reconnect(struct serio *serio) { serio_queue_event(serio, SERIO_RECONNECT); } irqreturn_t serio_interrupt(struct serio *serio, unsigned char data, unsigned int flags, struct pt_regs *regs) { irqreturn_t ret = IRQ_NONE; if (serio->dev && serio->dev->interrupt) { ret = serio->dev->interrupt(serio, data, flags, regs); } else { if (!flags) { if ((serio->type == SERIO_8042 || serio->type == SERIO_8042_XL) && (data != 0xaa)) return ret; serio_rescan(serio); ret = IRQ_HANDLED; } } return ret; } void serio_register_port(struct serio *serio) { down(&serio_sem); __serio_register_port(serio); up(&serio_sem); } /* * Submits register request to kseriod for subsequent execution. * Can be used when it is not obvious whether the serio_sem is * taken or not and when delayed execution is feasible. */ void serio_register_port_delayed(struct serio *serio) { serio_queue_event(serio, SERIO_REGISTER_PORT); } /* * Should only be called directly if serio_sem has already been taken, * for example when unregistering a serio from other input device's * connect() function. */ void __serio_register_port(struct serio *serio) { list_add_tail(&serio->node, &serio_list); serio_find_dev(serio); } void serio_unregister_port(struct serio *serio) { down(&serio_sem); __serio_unregister_port(serio); up(&serio_sem); } /* * Submits unregister request to kseriod for subsequent execution. * Can be used when it is not obvious whether the serio_sem is * taken or not and when delayed execution is feasible. */ void serio_unregister_port_delayed(struct serio *serio) { serio_queue_event(serio, SERIO_UNREGISTER_PORT); } /* * Should only be called directly if serio_sem has already been taken, * for example when unregistering a serio from other input device's * disconnect() function. */ void __serio_unregister_port(struct serio *serio) { serio_invalidate_pending_events(serio); list_del_init(&serio->node); if (serio->dev && serio->dev->disconnect) serio->dev->disconnect(serio); } void serio_register_device(struct serio_dev *dev) { struct serio *serio; down(&serio_sem); list_add_tail(&dev->node, &serio_dev_list); list_for_each_entry(serio, &serio_list, node) if (!serio->dev && dev->connect) dev->connect(serio, dev); up(&serio_sem); } void serio_unregister_device(struct serio_dev *dev) { struct serio *serio; down(&serio_sem); list_del_init(&dev->node); list_for_each_entry(serio, &serio_list, node) { if (serio->dev == dev && dev->disconnect) dev->disconnect(serio); serio_find_dev(serio); } up(&serio_sem); } /* called from serio_dev->connect/disconnect methods under serio_sem */ int serio_open(struct serio *serio, struct serio_dev *dev) { serio->dev = dev; if (serio->open(serio)) { serio->dev = NULL; return -1; } return 0; } /* called from serio_dev->connect/disconnect methods under serio_sem */ void serio_close(struct serio *serio) { serio->close(serio); serio->dev = NULL; } static int __init serio_init(void) { int pid; pid = kernel_thread(serio_thread, NULL, CLONE_KERNEL); if (!pid) { printk(KERN_WARNING "serio: Failed to start kseriod\n"); return -1; } serio_pid = pid; return 0; } static void __exit serio_exit(void) { kill_proc(serio_pid, SIGTERM, 1); wait_for_completion(&serio_exited); } module_init(serio_init); module_exit(serio_exit);