sysrq.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802
  1. /*
  2. * Linux Magic System Request Key Hacks
  3. *
  4. * (c) 1997 Martin Mares <mj@atrey.karlin.mff.cuni.cz>
  5. * based on ideas by Pavel Machek <pavel@atrey.karlin.mff.cuni.cz>
  6. *
  7. * (c) 2000 Crutcher Dunnavant <crutcher+kernel@datastacks.com>
  8. * overhauled to use key registration
  9. * based upon discusions in irc://irc.openprojects.net/#kernelnewbies
  10. *
  11. * Copyright (c) 2010 Dmitry Torokhov
  12. * Input handler conversion
  13. */
  14. #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  15. #include <linux/sched.h>
  16. #include <linux/interrupt.h>
  17. #include <linux/mm.h>
  18. #include <linux/fs.h>
  19. #include <linux/tty.h>
  20. #include <linux/mount.h>
  21. #include <linux/kdev_t.h>
  22. #include <linux/major.h>
  23. #include <linux/reboot.h>
  24. #include <linux/sysrq.h>
  25. #include <linux/kbd_kern.h>
  26. #include <linux/proc_fs.h>
  27. #include <linux/nmi.h>
  28. #include <linux/quotaops.h>
  29. #include <linux/perf_event.h>
  30. #include <linux/kernel.h>
  31. #include <linux/module.h>
  32. #include <linux/suspend.h>
  33. #include <linux/writeback.h>
  34. #include <linux/buffer_head.h> /* for fsync_bdev() */
  35. #include <linux/swap.h>
  36. #include <linux/spinlock.h>
  37. #include <linux/vt_kern.h>
  38. #include <linux/workqueue.h>
  39. #include <linux/hrtimer.h>
  40. #include <linux/oom.h>
  41. #include <linux/slab.h>
  42. #include <linux/input.h>
  43. #include <asm/ptrace.h>
  44. #include <asm/irq_regs.h>
  45. /* Whether we react on sysrq keys or just ignore them */
  46. static int __read_mostly sysrq_enabled = 1;
  47. static bool __read_mostly sysrq_always_enabled;
  48. static bool sysrq_on(void)
  49. {
  50. return sysrq_enabled || sysrq_always_enabled;
  51. }
  52. /*
  53. * A value of 1 means 'all', other nonzero values are an op mask:
  54. */
  55. static bool sysrq_on_mask(int mask)
  56. {
  57. return sysrq_always_enabled ||
  58. sysrq_enabled == 1 ||
  59. (sysrq_enabled & mask);
  60. }
  61. static int __init sysrq_always_enabled_setup(char *str)
  62. {
  63. sysrq_always_enabled = true;
  64. pr_info("sysrq always enabled.\n");
  65. return 1;
  66. }
  67. __setup("sysrq_always_enabled", sysrq_always_enabled_setup);
  68. static void sysrq_handle_loglevel(int key, struct tty_struct *tty)
  69. {
  70. int i;
  71. i = key - '0';
  72. console_loglevel = 7;
  73. printk("Loglevel set to %d\n", i);
  74. console_loglevel = i;
  75. }
  76. static struct sysrq_key_op sysrq_loglevel_op = {
  77. .handler = sysrq_handle_loglevel,
  78. .help_msg = "loglevel(0-9)",
  79. .action_msg = "Changing Loglevel",
  80. .enable_mask = SYSRQ_ENABLE_LOG,
  81. };
  82. #ifdef CONFIG_VT
  83. static void sysrq_handle_SAK(int key, struct tty_struct *tty)
  84. {
  85. struct work_struct *SAK_work = &vc_cons[fg_console].SAK_work;
  86. schedule_work(SAK_work);
  87. }
  88. static struct sysrq_key_op sysrq_SAK_op = {
  89. .handler = sysrq_handle_SAK,
  90. .help_msg = "saK",
  91. .action_msg = "SAK",
  92. .enable_mask = SYSRQ_ENABLE_KEYBOARD,
  93. };
  94. #else
  95. #define sysrq_SAK_op (*(struct sysrq_key_op *)NULL)
  96. #endif
  97. #ifdef CONFIG_VT
  98. static void sysrq_handle_unraw(int key, struct tty_struct *tty)
  99. {
  100. struct kbd_struct *kbd = &kbd_table[fg_console];
  101. if (kbd)
  102. kbd->kbdmode = default_utf8 ? VC_UNICODE : VC_XLATE;
  103. }
  104. static struct sysrq_key_op sysrq_unraw_op = {
  105. .handler = sysrq_handle_unraw,
  106. .help_msg = "unRaw",
  107. .action_msg = "Keyboard mode set to system default",
  108. .enable_mask = SYSRQ_ENABLE_KEYBOARD,
  109. };
  110. #else
  111. #define sysrq_unraw_op (*(struct sysrq_key_op *)NULL)
  112. #endif /* CONFIG_VT */
  113. static void sysrq_handle_crash(int key, struct tty_struct *tty)
  114. {
  115. char *killer = NULL;
  116. panic_on_oops = 1; /* force panic */
  117. wmb();
  118. *killer = 1;
  119. }
  120. static struct sysrq_key_op sysrq_crash_op = {
  121. .handler = sysrq_handle_crash,
  122. .help_msg = "Crash",
  123. .action_msg = "Trigger a crash",
  124. .enable_mask = SYSRQ_ENABLE_DUMP,
  125. };
  126. static void sysrq_handle_reboot(int key, struct tty_struct *tty)
  127. {
  128. lockdep_off();
  129. local_irq_enable();
  130. emergency_restart();
  131. }
  132. static struct sysrq_key_op sysrq_reboot_op = {
  133. .handler = sysrq_handle_reboot,
  134. .help_msg = "reBoot",
  135. .action_msg = "Resetting",
  136. .enable_mask = SYSRQ_ENABLE_BOOT,
  137. };
  138. static void sysrq_handle_sync(int key, struct tty_struct *tty)
  139. {
  140. emergency_sync();
  141. }
  142. static struct sysrq_key_op sysrq_sync_op = {
  143. .handler = sysrq_handle_sync,
  144. .help_msg = "Sync",
  145. .action_msg = "Emergency Sync",
  146. .enable_mask = SYSRQ_ENABLE_SYNC,
  147. };
  148. static void sysrq_handle_show_timers(int key, struct tty_struct *tty)
  149. {
  150. sysrq_timer_list_show();
  151. }
  152. static struct sysrq_key_op sysrq_show_timers_op = {
  153. .handler = sysrq_handle_show_timers,
  154. .help_msg = "show-all-timers(Q)",
  155. .action_msg = "Show clockevent devices & pending hrtimers (no others)",
  156. };
  157. static void sysrq_handle_mountro(int key, struct tty_struct *tty)
  158. {
  159. emergency_remount();
  160. }
  161. static struct sysrq_key_op sysrq_mountro_op = {
  162. .handler = sysrq_handle_mountro,
  163. .help_msg = "Unmount",
  164. .action_msg = "Emergency Remount R/O",
  165. .enable_mask = SYSRQ_ENABLE_REMOUNT,
  166. };
  167. #ifdef CONFIG_LOCKDEP
  168. static void sysrq_handle_showlocks(int key, struct tty_struct *tty)
  169. {
  170. debug_show_all_locks();
  171. }
  172. static struct sysrq_key_op sysrq_showlocks_op = {
  173. .handler = sysrq_handle_showlocks,
  174. .help_msg = "show-all-locks(D)",
  175. .action_msg = "Show Locks Held",
  176. };
  177. #else
  178. #define sysrq_showlocks_op (*(struct sysrq_key_op *)NULL)
  179. #endif
  180. #ifdef CONFIG_SMP
  181. static DEFINE_SPINLOCK(show_lock);
  182. static void showacpu(void *dummy)
  183. {
  184. unsigned long flags;
  185. /* Idle CPUs have no interesting backtrace. */
  186. if (idle_cpu(smp_processor_id()))
  187. return;
  188. spin_lock_irqsave(&show_lock, flags);
  189. printk(KERN_INFO "CPU%d:\n", smp_processor_id());
  190. show_stack(NULL, NULL);
  191. spin_unlock_irqrestore(&show_lock, flags);
  192. }
  193. static void sysrq_showregs_othercpus(struct work_struct *dummy)
  194. {
  195. smp_call_function(showacpu, NULL, 0);
  196. }
  197. static DECLARE_WORK(sysrq_showallcpus, sysrq_showregs_othercpus);
  198. static void sysrq_handle_showallcpus(int key, struct tty_struct *tty)
  199. {
  200. /*
  201. * Fall back to the workqueue based printing if the
  202. * backtrace printing did not succeed or the
  203. * architecture has no support for it:
  204. */
  205. if (!trigger_all_cpu_backtrace()) {
  206. struct pt_regs *regs = get_irq_regs();
  207. if (regs) {
  208. printk(KERN_INFO "CPU%d:\n", smp_processor_id());
  209. show_regs(regs);
  210. }
  211. schedule_work(&sysrq_showallcpus);
  212. }
  213. }
  214. static struct sysrq_key_op sysrq_showallcpus_op = {
  215. .handler = sysrq_handle_showallcpus,
  216. .help_msg = "show-backtrace-all-active-cpus(L)",
  217. .action_msg = "Show backtrace of all active CPUs",
  218. .enable_mask = SYSRQ_ENABLE_DUMP,
  219. };
  220. #endif
  221. static void sysrq_handle_showregs(int key, struct tty_struct *tty)
  222. {
  223. struct pt_regs *regs = get_irq_regs();
  224. if (regs)
  225. show_regs(regs);
  226. perf_event_print_debug();
  227. }
  228. static struct sysrq_key_op sysrq_showregs_op = {
  229. .handler = sysrq_handle_showregs,
  230. .help_msg = "show-registers(P)",
  231. .action_msg = "Show Regs",
  232. .enable_mask = SYSRQ_ENABLE_DUMP,
  233. };
  234. static void sysrq_handle_showstate(int key, struct tty_struct *tty)
  235. {
  236. show_state();
  237. }
  238. static struct sysrq_key_op sysrq_showstate_op = {
  239. .handler = sysrq_handle_showstate,
  240. .help_msg = "show-task-states(T)",
  241. .action_msg = "Show State",
  242. .enable_mask = SYSRQ_ENABLE_DUMP,
  243. };
  244. static void sysrq_handle_showstate_blocked(int key, struct tty_struct *tty)
  245. {
  246. show_state_filter(TASK_UNINTERRUPTIBLE);
  247. }
  248. static struct sysrq_key_op sysrq_showstate_blocked_op = {
  249. .handler = sysrq_handle_showstate_blocked,
  250. .help_msg = "show-blocked-tasks(W)",
  251. .action_msg = "Show Blocked State",
  252. .enable_mask = SYSRQ_ENABLE_DUMP,
  253. };
  254. #ifdef CONFIG_TRACING
  255. #include <linux/ftrace.h>
  256. static void sysrq_ftrace_dump(int key, struct tty_struct *tty)
  257. {
  258. ftrace_dump(DUMP_ALL);
  259. }
  260. static struct sysrq_key_op sysrq_ftrace_dump_op = {
  261. .handler = sysrq_ftrace_dump,
  262. .help_msg = "dump-ftrace-buffer(Z)",
  263. .action_msg = "Dump ftrace buffer",
  264. .enable_mask = SYSRQ_ENABLE_DUMP,
  265. };
  266. #else
  267. #define sysrq_ftrace_dump_op (*(struct sysrq_key_op *)NULL)
  268. #endif
  269. static void sysrq_handle_showmem(int key, struct tty_struct *tty)
  270. {
  271. show_mem();
  272. }
  273. static struct sysrq_key_op sysrq_showmem_op = {
  274. .handler = sysrq_handle_showmem,
  275. .help_msg = "show-memory-usage(M)",
  276. .action_msg = "Show Memory",
  277. .enable_mask = SYSRQ_ENABLE_DUMP,
  278. };
  279. /*
  280. * Signal sysrq helper function. Sends a signal to all user processes.
  281. */
  282. static void send_sig_all(int sig)
  283. {
  284. struct task_struct *p;
  285. for_each_process(p) {
  286. if (p->mm && !is_global_init(p))
  287. /* Not swapper, init nor kernel thread */
  288. force_sig(sig, p);
  289. }
  290. }
  291. static void sysrq_handle_term(int key, struct tty_struct *tty)
  292. {
  293. send_sig_all(SIGTERM);
  294. console_loglevel = 8;
  295. }
  296. static struct sysrq_key_op sysrq_term_op = {
  297. .handler = sysrq_handle_term,
  298. .help_msg = "terminate-all-tasks(E)",
  299. .action_msg = "Terminate All Tasks",
  300. .enable_mask = SYSRQ_ENABLE_SIGNAL,
  301. };
  302. static void moom_callback(struct work_struct *ignored)
  303. {
  304. out_of_memory(node_zonelist(0, GFP_KERNEL), GFP_KERNEL, 0, NULL);
  305. }
  306. static DECLARE_WORK(moom_work, moom_callback);
  307. static void sysrq_handle_moom(int key, struct tty_struct *tty)
  308. {
  309. schedule_work(&moom_work);
  310. }
  311. static struct sysrq_key_op sysrq_moom_op = {
  312. .handler = sysrq_handle_moom,
  313. .help_msg = "memory-full-oom-kill(F)",
  314. .action_msg = "Manual OOM execution",
  315. .enable_mask = SYSRQ_ENABLE_SIGNAL,
  316. };
  317. #ifdef CONFIG_BLOCK
  318. static void sysrq_handle_thaw(int key, struct tty_struct *tty)
  319. {
  320. emergency_thaw_all();
  321. }
  322. static struct sysrq_key_op sysrq_thaw_op = {
  323. .handler = sysrq_handle_thaw,
  324. .help_msg = "thaw-filesystems(J)",
  325. .action_msg = "Emergency Thaw of all frozen filesystems",
  326. .enable_mask = SYSRQ_ENABLE_SIGNAL,
  327. };
  328. #endif
  329. static void sysrq_handle_kill(int key, struct tty_struct *tty)
  330. {
  331. send_sig_all(SIGKILL);
  332. console_loglevel = 8;
  333. }
  334. static struct sysrq_key_op sysrq_kill_op = {
  335. .handler = sysrq_handle_kill,
  336. .help_msg = "kill-all-tasks(I)",
  337. .action_msg = "Kill All Tasks",
  338. .enable_mask = SYSRQ_ENABLE_SIGNAL,
  339. };
  340. static void sysrq_handle_unrt(int key, struct tty_struct *tty)
  341. {
  342. normalize_rt_tasks();
  343. }
  344. static struct sysrq_key_op sysrq_unrt_op = {
  345. .handler = sysrq_handle_unrt,
  346. .help_msg = "nice-all-RT-tasks(N)",
  347. .action_msg = "Nice All RT Tasks",
  348. .enable_mask = SYSRQ_ENABLE_RTNICE,
  349. };
  350. /* Key Operations table and lock */
  351. static DEFINE_SPINLOCK(sysrq_key_table_lock);
  352. static struct sysrq_key_op *sysrq_key_table[36] = {
  353. &sysrq_loglevel_op, /* 0 */
  354. &sysrq_loglevel_op, /* 1 */
  355. &sysrq_loglevel_op, /* 2 */
  356. &sysrq_loglevel_op, /* 3 */
  357. &sysrq_loglevel_op, /* 4 */
  358. &sysrq_loglevel_op, /* 5 */
  359. &sysrq_loglevel_op, /* 6 */
  360. &sysrq_loglevel_op, /* 7 */
  361. &sysrq_loglevel_op, /* 8 */
  362. &sysrq_loglevel_op, /* 9 */
  363. /*
  364. * a: Don't use for system provided sysrqs, it is handled specially on
  365. * sparc and will never arrive.
  366. */
  367. NULL, /* a */
  368. &sysrq_reboot_op, /* b */
  369. &sysrq_crash_op, /* c & ibm_emac driver debug */
  370. &sysrq_showlocks_op, /* d */
  371. &sysrq_term_op, /* e */
  372. &sysrq_moom_op, /* f */
  373. /* g: May be registered for the kernel debugger */
  374. NULL, /* g */
  375. NULL, /* h - reserved for help */
  376. &sysrq_kill_op, /* i */
  377. #ifdef CONFIG_BLOCK
  378. &sysrq_thaw_op, /* j */
  379. #else
  380. NULL, /* j */
  381. #endif
  382. &sysrq_SAK_op, /* k */
  383. #ifdef CONFIG_SMP
  384. &sysrq_showallcpus_op, /* l */
  385. #else
  386. NULL, /* l */
  387. #endif
  388. &sysrq_showmem_op, /* m */
  389. &sysrq_unrt_op, /* n */
  390. /* o: This will often be registered as 'Off' at init time */
  391. NULL, /* o */
  392. &sysrq_showregs_op, /* p */
  393. &sysrq_show_timers_op, /* q */
  394. &sysrq_unraw_op, /* r */
  395. &sysrq_sync_op, /* s */
  396. &sysrq_showstate_op, /* t */
  397. &sysrq_mountro_op, /* u */
  398. /* v: May be registered for frame buffer console restore */
  399. NULL, /* v */
  400. &sysrq_showstate_blocked_op, /* w */
  401. /* x: May be registered on ppc/powerpc for xmon */
  402. NULL, /* x */
  403. /* y: May be registered on sparc64 for global register dump */
  404. NULL, /* y */
  405. &sysrq_ftrace_dump_op, /* z */
  406. };
  407. /* key2index calculation, -1 on invalid index */
  408. static int sysrq_key_table_key2index(int key)
  409. {
  410. int retval;
  411. if ((key >= '0') && (key <= '9'))
  412. retval = key - '0';
  413. else if ((key >= 'a') && (key <= 'z'))
  414. retval = key + 10 - 'a';
  415. else
  416. retval = -1;
  417. return retval;
  418. }
  419. /*
  420. * get and put functions for the table, exposed to modules.
  421. */
  422. struct sysrq_key_op *__sysrq_get_key_op(int key)
  423. {
  424. struct sysrq_key_op *op_p = NULL;
  425. int i;
  426. i = sysrq_key_table_key2index(key);
  427. if (i != -1)
  428. op_p = sysrq_key_table[i];
  429. return op_p;
  430. }
  431. static void __sysrq_put_key_op(int key, struct sysrq_key_op *op_p)
  432. {
  433. int i = sysrq_key_table_key2index(key);
  434. if (i != -1)
  435. sysrq_key_table[i] = op_p;
  436. }
  437. void __handle_sysrq(int key, struct tty_struct *tty, int check_mask)
  438. {
  439. struct sysrq_key_op *op_p;
  440. int orig_log_level;
  441. int i;
  442. unsigned long flags;
  443. spin_lock_irqsave(&sysrq_key_table_lock, flags);
  444. /*
  445. * Raise the apparent loglevel to maximum so that the sysrq header
  446. * is shown to provide the user with positive feedback. We do not
  447. * simply emit this at KERN_EMERG as that would change message
  448. * routing in the consumers of /proc/kmsg.
  449. */
  450. orig_log_level = console_loglevel;
  451. console_loglevel = 7;
  452. printk(KERN_INFO "SysRq : ");
  453. op_p = __sysrq_get_key_op(key);
  454. if (op_p) {
  455. /*
  456. * Should we check for enabled operations (/proc/sysrq-trigger
  457. * should not) and is the invoked operation enabled?
  458. */
  459. if (!check_mask || sysrq_on_mask(op_p->enable_mask)) {
  460. printk("%s\n", op_p->action_msg);
  461. console_loglevel = orig_log_level;
  462. op_p->handler(key, tty);
  463. } else {
  464. printk("This sysrq operation is disabled.\n");
  465. }
  466. } else {
  467. printk("HELP : ");
  468. /* Only print the help msg once per handler */
  469. for (i = 0; i < ARRAY_SIZE(sysrq_key_table); i++) {
  470. if (sysrq_key_table[i]) {
  471. int j;
  472. for (j = 0; sysrq_key_table[i] !=
  473. sysrq_key_table[j]; j++)
  474. ;
  475. if (j != i)
  476. continue;
  477. printk("%s ", sysrq_key_table[i]->help_msg);
  478. }
  479. }
  480. printk("\n");
  481. console_loglevel = orig_log_level;
  482. }
  483. spin_unlock_irqrestore(&sysrq_key_table_lock, flags);
  484. }
  485. void handle_sysrq(int key, struct tty_struct *tty)
  486. {
  487. if (sysrq_on())
  488. __handle_sysrq(key, tty, 1);
  489. }
  490. EXPORT_SYMBOL(handle_sysrq);
  491. #ifdef CONFIG_INPUT
  492. /* Simple translation table for the SysRq keys */
  493. static const unsigned char sysrq_xlate[KEY_MAX + 1] =
  494. "\000\0331234567890-=\177\t" /* 0x00 - 0x0f */
  495. "qwertyuiop[]\r\000as" /* 0x10 - 0x1f */
  496. "dfghjkl;'`\000\\zxcv" /* 0x20 - 0x2f */
  497. "bnm,./\000*\000 \000\201\202\203\204\205" /* 0x30 - 0x3f */
  498. "\206\207\210\211\212\000\000789-456+1" /* 0x40 - 0x4f */
  499. "230\177\000\000\213\214\000\000\000\000\000\000\000\000\000\000" /* 0x50 - 0x5f */
  500. "\r\000/"; /* 0x60 - 0x6f */
  501. static bool sysrq_down;
  502. static int sysrq_alt_use;
  503. static int sysrq_alt;
  504. static bool sysrq_filter(struct input_handle *handle, unsigned int type,
  505. unsigned int code, int value)
  506. {
  507. if (type != EV_KEY)
  508. goto out;
  509. switch (code) {
  510. case KEY_LEFTALT:
  511. case KEY_RIGHTALT:
  512. if (value)
  513. sysrq_alt = code;
  514. else {
  515. if (sysrq_down && code == sysrq_alt_use)
  516. sysrq_down = false;
  517. sysrq_alt = 0;
  518. }
  519. break;
  520. case KEY_SYSRQ:
  521. if (value == 1 && sysrq_alt) {
  522. sysrq_down = true;
  523. sysrq_alt_use = sysrq_alt;
  524. }
  525. break;
  526. default:
  527. if (sysrq_down && value && value != 2)
  528. __handle_sysrq(sysrq_xlate[code], NULL, 1);
  529. break;
  530. }
  531. out:
  532. return sysrq_down;
  533. }
  534. static int sysrq_connect(struct input_handler *handler,
  535. struct input_dev *dev,
  536. const struct input_device_id *id)
  537. {
  538. struct input_handle *handle;
  539. int error;
  540. sysrq_down = false;
  541. sysrq_alt = 0;
  542. handle = kzalloc(sizeof(struct input_handle), GFP_KERNEL);
  543. if (!handle)
  544. return -ENOMEM;
  545. handle->dev = dev;
  546. handle->handler = handler;
  547. handle->name = "sysrq";
  548. error = input_register_handle(handle);
  549. if (error) {
  550. pr_err("Failed to register input sysrq handler, error %d\n",
  551. error);
  552. goto err_free;
  553. }
  554. error = input_open_device(handle);
  555. if (error) {
  556. pr_err("Failed to open input device, error %d\n", error);
  557. goto err_unregister;
  558. }
  559. return 0;
  560. err_unregister:
  561. input_unregister_handle(handle);
  562. err_free:
  563. kfree(handle);
  564. return error;
  565. }
  566. static void sysrq_disconnect(struct input_handle *handle)
  567. {
  568. input_close_device(handle);
  569. input_unregister_handle(handle);
  570. kfree(handle);
  571. }
  572. /*
  573. * We are matching on KEY_LEFTALT insteard of KEY_SYSRQ because not all
  574. * keyboards have SysRq ikey predefined and so user may add it to keymap
  575. * later, but we expect all such keyboards to have left alt.
  576. */
  577. static const struct input_device_id sysrq_ids[] = {
  578. {
  579. .flags = INPUT_DEVICE_ID_MATCH_EVBIT |
  580. INPUT_DEVICE_ID_MATCH_KEYBIT,
  581. .evbit = { BIT_MASK(EV_KEY) },
  582. .keybit = { BIT_MASK(KEY_LEFTALT) },
  583. },
  584. { },
  585. };
  586. static struct input_handler sysrq_handler = {
  587. .filter = sysrq_filter,
  588. .connect = sysrq_connect,
  589. .disconnect = sysrq_disconnect,
  590. .name = "sysrq",
  591. .id_table = sysrq_ids,
  592. };
  593. static bool sysrq_handler_registered;
  594. static inline void sysrq_register_handler(void)
  595. {
  596. int error;
  597. error = input_register_handler(&sysrq_handler);
  598. if (error)
  599. pr_err("Failed to register input handler, error %d", error);
  600. else
  601. sysrq_handler_registered = true;
  602. }
  603. static inline void sysrq_unregister_handler(void)
  604. {
  605. if (sysrq_handler_registered) {
  606. input_unregister_handler(&sysrq_handler);
  607. sysrq_handler_registered = false;
  608. }
  609. }
  610. #else
  611. static inline void sysrq_register_handler(void)
  612. {
  613. }
  614. static inline void sysrq_unregister_handler(void)
  615. {
  616. }
  617. #endif /* CONFIG_INPUT */
  618. int sysrq_toggle_support(int enable_mask)
  619. {
  620. bool was_enabled = sysrq_on();
  621. sysrq_enabled = enable_mask;
  622. if (was_enabled != sysrq_on()) {
  623. if (sysrq_on())
  624. sysrq_register_handler();
  625. else
  626. sysrq_unregister_handler();
  627. }
  628. return 0;
  629. }
  630. static int __sysrq_swap_key_ops(int key, struct sysrq_key_op *insert_op_p,
  631. struct sysrq_key_op *remove_op_p)
  632. {
  633. int retval;
  634. unsigned long flags;
  635. spin_lock_irqsave(&sysrq_key_table_lock, flags);
  636. if (__sysrq_get_key_op(key) == remove_op_p) {
  637. __sysrq_put_key_op(key, insert_op_p);
  638. retval = 0;
  639. } else {
  640. retval = -1;
  641. }
  642. spin_unlock_irqrestore(&sysrq_key_table_lock, flags);
  643. return retval;
  644. }
  645. int register_sysrq_key(int key, struct sysrq_key_op *op_p)
  646. {
  647. return __sysrq_swap_key_ops(key, op_p, NULL);
  648. }
  649. EXPORT_SYMBOL(register_sysrq_key);
  650. int unregister_sysrq_key(int key, struct sysrq_key_op *op_p)
  651. {
  652. return __sysrq_swap_key_ops(key, NULL, op_p);
  653. }
  654. EXPORT_SYMBOL(unregister_sysrq_key);
  655. #ifdef CONFIG_PROC_FS
  656. /*
  657. * writing 'C' to /proc/sysrq-trigger is like sysrq-C
  658. */
  659. static ssize_t write_sysrq_trigger(struct file *file, const char __user *buf,
  660. size_t count, loff_t *ppos)
  661. {
  662. if (count) {
  663. char c;
  664. if (get_user(c, buf))
  665. return -EFAULT;
  666. __handle_sysrq(c, NULL, 0);
  667. }
  668. return count;
  669. }
  670. static const struct file_operations proc_sysrq_trigger_operations = {
  671. .write = write_sysrq_trigger,
  672. };
  673. static void sysrq_init_procfs(void)
  674. {
  675. if (!proc_create("sysrq-trigger", S_IWUSR, NULL,
  676. &proc_sysrq_trigger_operations))
  677. pr_err("Failed to register proc interface\n");
  678. }
  679. #else
  680. static inline void sysrq_init_procfs(void)
  681. {
  682. }
  683. #endif /* CONFIG_PROC_FS */
  684. static int __init sysrq_init(void)
  685. {
  686. sysrq_init_procfs();
  687. if (sysrq_on())
  688. sysrq_register_handler();
  689. return 0;
  690. }
  691. module_init(sysrq_init);