blink.c 972 B

123456789101112131415161718192021222324252627282930313233343536373839404142434445
  1. #include <linux/kernel.h>
  2. #include <linux/module.h>
  3. #include <linux/timer.h>
  4. #include <linux/jiffies.h>
  5. static void do_blink(unsigned long data);
  6. static DEFINE_TIMER(blink_timer, do_blink, 0 ,0);
  7. static void do_blink(unsigned long data)
  8. {
  9. static long count;
  10. if (panic_blink)
  11. panic_blink(count++);
  12. blink_timer.expires = jiffies + msecs_to_jiffies(1);
  13. add_timer(&blink_timer);
  14. }
  15. static int blink_panic_event(struct notifier_block *blk,
  16. unsigned long event, void *arg)
  17. {
  18. do_blink(0);
  19. return 0;
  20. }
  21. static struct notifier_block blink_notify = {
  22. .notifier_call = blink_panic_event,
  23. };
  24. static __init int blink_init(void)
  25. {
  26. printk(KERN_INFO "Enabling keyboard blinking\n");
  27. atomic_notifier_chain_register(&panic_notifier_list, &blink_notify);
  28. return 0;
  29. }
  30. static __exit void blink_remove(void)
  31. {
  32. del_timer_sync(&blink_timer);
  33. atomic_notifier_chain_unregister(&panic_notifier_list, &blink_notify);
  34. }
  35. module_init(blink_init);
  36. module_exit(blink_remove);