atkbd.c 34 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397
  1. /*
  2. * AT and PS/2 keyboard driver
  3. *
  4. * Copyright (c) 1999-2002 Vojtech Pavlik
  5. */
  6. /*
  7. * This program is free software; you can redistribute it and/or modify it
  8. * under the terms of the GNU General Public License version 2 as published by
  9. * the Free Software Foundation.
  10. */
  11. /*
  12. * This driver can handle standard AT keyboards and PS/2 keyboards in
  13. * Translated and Raw Set 2 and Set 3, as well as AT keyboards on dumb
  14. * input-only controllers and AT keyboards connected over a one way RS232
  15. * converter.
  16. */
  17. #include <linux/delay.h>
  18. #include <linux/module.h>
  19. #include <linux/moduleparam.h>
  20. #include <linux/slab.h>
  21. #include <linux/interrupt.h>
  22. #include <linux/init.h>
  23. #include <linux/input.h>
  24. #include <linux/serio.h>
  25. #include <linux/workqueue.h>
  26. #include <linux/libps2.h>
  27. #include <linux/mutex.h>
  28. #define DRIVER_DESC "AT and PS/2 keyboard driver"
  29. MODULE_AUTHOR("Vojtech Pavlik <vojtech@suse.cz>");
  30. MODULE_DESCRIPTION(DRIVER_DESC);
  31. MODULE_LICENSE("GPL");
  32. static int atkbd_set = 2;
  33. module_param_named(set, atkbd_set, int, 0);
  34. MODULE_PARM_DESC(set, "Select keyboard code set (2 = default, 3 = PS/2 native)");
  35. #if defined(__i386__) || defined(__x86_64__) || defined(__hppa__)
  36. static int atkbd_reset;
  37. #else
  38. static int atkbd_reset = 1;
  39. #endif
  40. module_param_named(reset, atkbd_reset, bool, 0);
  41. MODULE_PARM_DESC(reset, "Reset keyboard during initialization");
  42. static int atkbd_softrepeat;
  43. module_param_named(softrepeat, atkbd_softrepeat, bool, 0);
  44. MODULE_PARM_DESC(softrepeat, "Use software keyboard repeat");
  45. static int atkbd_softraw = 1;
  46. module_param_named(softraw, atkbd_softraw, bool, 0);
  47. MODULE_PARM_DESC(softraw, "Use software generated rawmode");
  48. static int atkbd_scroll;
  49. module_param_named(scroll, atkbd_scroll, bool, 0);
  50. MODULE_PARM_DESC(scroll, "Enable scroll-wheel on MS Office and similar keyboards");
  51. static int atkbd_extra;
  52. module_param_named(extra, atkbd_extra, bool, 0);
  53. MODULE_PARM_DESC(extra, "Enable extra LEDs and keys on IBM RapidAcces, EzKey and similar keyboards");
  54. /*
  55. * Scancode to keycode tables. These are just the default setting, and
  56. * are loadable via an userland utility.
  57. */
  58. static unsigned char atkbd_set2_keycode[512] = {
  59. #ifdef CONFIG_KEYBOARD_ATKBD_HP_KEYCODES
  60. /* XXX: need a more general approach */
  61. #include "hpps2atkbd.h" /* include the keyboard scancodes */
  62. #else
  63. 0, 67, 65, 63, 61, 59, 60, 88, 0, 68, 66, 64, 62, 15, 41,117,
  64. 0, 56, 42, 93, 29, 16, 2, 0, 0, 0, 44, 31, 30, 17, 3, 0,
  65. 0, 46, 45, 32, 18, 5, 4, 95, 0, 57, 47, 33, 20, 19, 6,183,
  66. 0, 49, 48, 35, 34, 21, 7,184, 0, 0, 50, 36, 22, 8, 9,185,
  67. 0, 51, 37, 23, 24, 11, 10, 0, 0, 52, 53, 38, 39, 25, 12, 0,
  68. 0, 89, 40, 0, 26, 13, 0, 0, 58, 54, 28, 27, 0, 43, 0, 85,
  69. 0, 86, 91, 90, 92, 0, 14, 94, 0, 79,124, 75, 71,121, 0, 0,
  70. 82, 83, 80, 76, 77, 72, 1, 69, 87, 78, 81, 74, 55, 73, 70, 99,
  71. 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
  72. 217,100,255, 0, 97,165, 0, 0,156, 0, 0, 0, 0, 0, 0,125,
  73. 173,114, 0,113, 0, 0, 0,126,128, 0, 0,140, 0, 0, 0,127,
  74. 159, 0,115, 0,164, 0, 0,116,158, 0,150,166, 0, 0, 0,142,
  75. 157, 0, 0, 0, 0, 0, 0, 0,155, 0, 98, 0, 0,163, 0, 0,
  76. 226, 0, 0, 0, 0, 0, 0, 0, 0,255, 96, 0, 0, 0,143, 0,
  77. 0, 0, 0, 0, 0, 0, 0, 0, 0,107, 0,105,102, 0, 0,112,
  78. 110,111,108,112,106,103, 0,119, 0,118,109, 0, 99,104,119, 0,
  79. 0, 0, 0, 65, 99,
  80. #endif
  81. };
  82. static unsigned char atkbd_set3_keycode[512] = {
  83. 0, 0, 0, 0, 0, 0, 0, 59, 1,138,128,129,130, 15, 41, 60,
  84. 131, 29, 42, 86, 58, 16, 2, 61,133, 56, 44, 31, 30, 17, 3, 62,
  85. 134, 46, 45, 32, 18, 5, 4, 63,135, 57, 47, 33, 20, 19, 6, 64,
  86. 136, 49, 48, 35, 34, 21, 7, 65,137,100, 50, 36, 22, 8, 9, 66,
  87. 125, 51, 37, 23, 24, 11, 10, 67,126, 52, 53, 38, 39, 25, 12, 68,
  88. 113,114, 40, 43, 26, 13, 87, 99, 97, 54, 28, 27, 43, 43, 88, 70,
  89. 108,105,119,103,111,107, 14,110, 0, 79,106, 75, 71,109,102,104,
  90. 82, 83, 80, 76, 77, 72, 69, 98, 0, 96, 81, 0, 78, 73, 55,183,
  91. 184,185,186,187, 74, 94, 92, 93, 0, 0, 0,125,126,127,112, 0,
  92. 0,139,150,163,165,115,152,150,166,140,160,154,113,114,167,168,
  93. 148,149,147,140
  94. };
  95. static unsigned char atkbd_unxlate_table[128] = {
  96. 0,118, 22, 30, 38, 37, 46, 54, 61, 62, 70, 69, 78, 85,102, 13,
  97. 21, 29, 36, 45, 44, 53, 60, 67, 68, 77, 84, 91, 90, 20, 28, 27,
  98. 35, 43, 52, 51, 59, 66, 75, 76, 82, 14, 18, 93, 26, 34, 33, 42,
  99. 50, 49, 58, 65, 73, 74, 89,124, 17, 41, 88, 5, 6, 4, 12, 3,
  100. 11, 2, 10, 1, 9,119,126,108,117,125,123,107,115,116,121,105,
  101. 114,122,112,113,127, 96, 97,120, 7, 15, 23, 31, 39, 47, 55, 63,
  102. 71, 79, 86, 94, 8, 16, 24, 32, 40, 48, 56, 64, 72, 80, 87,111,
  103. 19, 25, 57, 81, 83, 92, 95, 98, 99,100,101,103,104,106,109,110
  104. };
  105. #define ATKBD_CMD_SETLEDS 0x10ed
  106. #define ATKBD_CMD_GSCANSET 0x11f0
  107. #define ATKBD_CMD_SSCANSET 0x10f0
  108. #define ATKBD_CMD_GETID 0x02f2
  109. #define ATKBD_CMD_SETREP 0x10f3
  110. #define ATKBD_CMD_ENABLE 0x00f4
  111. #define ATKBD_CMD_RESET_DIS 0x00f5
  112. #define ATKBD_CMD_SETALL_MBR 0x00fa
  113. #define ATKBD_CMD_RESET_BAT 0x02ff
  114. #define ATKBD_CMD_RESEND 0x00fe
  115. #define ATKBD_CMD_EX_ENABLE 0x10ea
  116. #define ATKBD_CMD_EX_SETLEDS 0x20eb
  117. #define ATKBD_CMD_OK_GETID 0x02e8
  118. #define ATKBD_RET_ACK 0xfa
  119. #define ATKBD_RET_NAK 0xfe
  120. #define ATKBD_RET_BAT 0xaa
  121. #define ATKBD_RET_EMUL0 0xe0
  122. #define ATKBD_RET_EMUL1 0xe1
  123. #define ATKBD_RET_RELEASE 0xf0
  124. #define ATKBD_RET_HANJA 0xf1
  125. #define ATKBD_RET_HANGEUL 0xf2
  126. #define ATKBD_RET_ERR 0xff
  127. #define ATKBD_KEY_UNKNOWN 0
  128. #define ATKBD_KEY_NULL 255
  129. #define ATKBD_SCR_1 254
  130. #define ATKBD_SCR_2 253
  131. #define ATKBD_SCR_4 252
  132. #define ATKBD_SCR_8 251
  133. #define ATKBD_SCR_CLICK 250
  134. #define ATKBD_SCR_LEFT 249
  135. #define ATKBD_SCR_RIGHT 248
  136. #define ATKBD_SPECIAL 248
  137. #define ATKBD_LED_EVENT_BIT 0
  138. #define ATKBD_REP_EVENT_BIT 1
  139. #define ATKBD_XL_ERR 0x01
  140. #define ATKBD_XL_BAT 0x02
  141. #define ATKBD_XL_ACK 0x04
  142. #define ATKBD_XL_NAK 0x08
  143. #define ATKBD_XL_HANGEUL 0x10
  144. #define ATKBD_XL_HANJA 0x20
  145. static struct {
  146. unsigned char keycode;
  147. unsigned char set2;
  148. } atkbd_scroll_keys[] = {
  149. { ATKBD_SCR_1, 0xc5 },
  150. { ATKBD_SCR_2, 0x9d },
  151. { ATKBD_SCR_4, 0xa4 },
  152. { ATKBD_SCR_8, 0x9b },
  153. { ATKBD_SCR_CLICK, 0xe0 },
  154. { ATKBD_SCR_LEFT, 0xcb },
  155. { ATKBD_SCR_RIGHT, 0xd2 },
  156. };
  157. /*
  158. * The atkbd control structure
  159. */
  160. struct atkbd {
  161. struct ps2dev ps2dev;
  162. struct input_dev *dev;
  163. /* Written only during init */
  164. char name[64];
  165. char phys[32];
  166. unsigned short id;
  167. unsigned char keycode[512];
  168. unsigned char set;
  169. unsigned char translated;
  170. unsigned char extra;
  171. unsigned char write;
  172. unsigned char softrepeat;
  173. unsigned char softraw;
  174. unsigned char scroll;
  175. unsigned char enabled;
  176. /* Accessed only from interrupt */
  177. unsigned char emul;
  178. unsigned char resend;
  179. unsigned char release;
  180. unsigned long xl_bit;
  181. unsigned int last;
  182. unsigned long time;
  183. unsigned long err_count;
  184. struct work_struct event_work;
  185. struct mutex event_mutex;
  186. unsigned long event_mask;
  187. };
  188. static ssize_t atkbd_attr_show_helper(struct device *dev, char *buf,
  189. ssize_t (*handler)(struct atkbd *, char *));
  190. static ssize_t atkbd_attr_set_helper(struct device *dev, const char *buf, size_t count,
  191. ssize_t (*handler)(struct atkbd *, const char *, size_t));
  192. #define ATKBD_DEFINE_ATTR(_name) \
  193. static ssize_t atkbd_show_##_name(struct atkbd *, char *); \
  194. static ssize_t atkbd_set_##_name(struct atkbd *, const char *, size_t); \
  195. static ssize_t atkbd_do_show_##_name(struct device *d, \
  196. struct device_attribute *attr, char *b) \
  197. { \
  198. return atkbd_attr_show_helper(d, b, atkbd_show_##_name); \
  199. } \
  200. static ssize_t atkbd_do_set_##_name(struct device *d, \
  201. struct device_attribute *attr, const char *b, size_t s) \
  202. { \
  203. return atkbd_attr_set_helper(d, b, s, atkbd_set_##_name); \
  204. } \
  205. static struct device_attribute atkbd_attr_##_name = \
  206. __ATTR(_name, S_IWUSR | S_IRUGO, atkbd_do_show_##_name, atkbd_do_set_##_name);
  207. ATKBD_DEFINE_ATTR(extra);
  208. ATKBD_DEFINE_ATTR(scroll);
  209. ATKBD_DEFINE_ATTR(set);
  210. ATKBD_DEFINE_ATTR(softrepeat);
  211. ATKBD_DEFINE_ATTR(softraw);
  212. #define ATKBD_DEFINE_RO_ATTR(_name) \
  213. static ssize_t atkbd_show_##_name(struct atkbd *, char *); \
  214. static ssize_t atkbd_do_show_##_name(struct device *d, \
  215. struct device_attribute *attr, char *b) \
  216. { \
  217. return atkbd_attr_show_helper(d, b, atkbd_show_##_name); \
  218. } \
  219. static struct device_attribute atkbd_attr_##_name = \
  220. __ATTR(_name, S_IRUGO, atkbd_do_show_##_name, NULL);
  221. ATKBD_DEFINE_RO_ATTR(err_count);
  222. static struct attribute *atkbd_attributes[] = {
  223. &atkbd_attr_extra.attr,
  224. &atkbd_attr_scroll.attr,
  225. &atkbd_attr_set.attr,
  226. &atkbd_attr_softrepeat.attr,
  227. &atkbd_attr_softraw.attr,
  228. &atkbd_attr_err_count.attr,
  229. NULL
  230. };
  231. static struct attribute_group atkbd_attribute_group = {
  232. .attrs = atkbd_attributes,
  233. };
  234. static const unsigned int xl_table[] = {
  235. ATKBD_RET_BAT, ATKBD_RET_ERR, ATKBD_RET_ACK,
  236. ATKBD_RET_NAK, ATKBD_RET_HANJA, ATKBD_RET_HANGEUL,
  237. };
  238. /*
  239. * Checks if we should mangle the scancode to extract 'release' bit
  240. * in translated mode.
  241. */
  242. static int atkbd_need_xlate(unsigned long xl_bit, unsigned char code)
  243. {
  244. int i;
  245. if (code == ATKBD_RET_EMUL0 || code == ATKBD_RET_EMUL1)
  246. return 0;
  247. for (i = 0; i < ARRAY_SIZE(xl_table); i++)
  248. if (code == xl_table[i])
  249. return test_bit(i, &xl_bit);
  250. return 1;
  251. }
  252. /*
  253. * Calculates new value of xl_bit so the driver can distinguish
  254. * between make/break pair of scancodes for select keys and PS/2
  255. * protocol responses.
  256. */
  257. static void atkbd_calculate_xl_bit(struct atkbd *atkbd, unsigned char code)
  258. {
  259. int i;
  260. for (i = 0; i < ARRAY_SIZE(xl_table); i++) {
  261. if (!((code ^ xl_table[i]) & 0x7f)) {
  262. if (code & 0x80)
  263. __clear_bit(i, &atkbd->xl_bit);
  264. else
  265. __set_bit(i, &atkbd->xl_bit);
  266. break;
  267. }
  268. }
  269. }
  270. /*
  271. * Encode the scancode, 0xe0 prefix, and high bit into a single integer,
  272. * keeping kernel 2.4 compatibility for set 2
  273. */
  274. static unsigned int atkbd_compat_scancode(struct atkbd *atkbd, unsigned int code)
  275. {
  276. if (atkbd->set == 3) {
  277. if (atkbd->emul == 1)
  278. code |= 0x100;
  279. } else {
  280. code = (code & 0x7f) | ((code & 0x80) << 1);
  281. if (atkbd->emul == 1)
  282. code |= 0x80;
  283. }
  284. return code;
  285. }
  286. /*
  287. * atkbd_interrupt(). Here takes place processing of data received from
  288. * the keyboard into events.
  289. */
  290. static irqreturn_t atkbd_interrupt(struct serio *serio, unsigned char data,
  291. unsigned int flags)
  292. {
  293. struct atkbd *atkbd = serio_get_drvdata(serio);
  294. struct input_dev *dev = atkbd->dev;
  295. unsigned int code = data;
  296. int scroll = 0, hscroll = 0, click = -1, add_release_event = 0;
  297. int value;
  298. unsigned char keycode;
  299. #ifdef ATKBD_DEBUG
  300. printk(KERN_DEBUG "atkbd.c: Received %02x flags %02x\n", data, flags);
  301. #endif
  302. #if !defined(__i386__) && !defined (__x86_64__)
  303. if ((flags & (SERIO_FRAME | SERIO_PARITY)) && (~flags & SERIO_TIMEOUT) && !atkbd->resend && atkbd->write) {
  304. printk(KERN_WARNING "atkbd.c: frame/parity error: %02x\n", flags);
  305. serio_write(serio, ATKBD_CMD_RESEND);
  306. atkbd->resend = 1;
  307. goto out;
  308. }
  309. if (!flags && data == ATKBD_RET_ACK)
  310. atkbd->resend = 0;
  311. #endif
  312. if (unlikely(atkbd->ps2dev.flags & PS2_FLAG_ACK))
  313. if (ps2_handle_ack(&atkbd->ps2dev, data))
  314. goto out;
  315. if (unlikely(atkbd->ps2dev.flags & PS2_FLAG_CMD))
  316. if (ps2_handle_response(&atkbd->ps2dev, data))
  317. goto out;
  318. if (!atkbd->enabled)
  319. goto out;
  320. input_event(dev, EV_MSC, MSC_RAW, code);
  321. if (atkbd->translated) {
  322. if (atkbd->emul || atkbd_need_xlate(atkbd->xl_bit, code)) {
  323. atkbd->release = code >> 7;
  324. code &= 0x7f;
  325. }
  326. if (!atkbd->emul)
  327. atkbd_calculate_xl_bit(atkbd, data);
  328. }
  329. switch (code) {
  330. case ATKBD_RET_BAT:
  331. atkbd->enabled = 0;
  332. serio_reconnect(atkbd->ps2dev.serio);
  333. goto out;
  334. case ATKBD_RET_EMUL0:
  335. atkbd->emul = 1;
  336. goto out;
  337. case ATKBD_RET_EMUL1:
  338. atkbd->emul = 2;
  339. goto out;
  340. case ATKBD_RET_RELEASE:
  341. atkbd->release = 1;
  342. goto out;
  343. case ATKBD_RET_ACK:
  344. case ATKBD_RET_NAK:
  345. printk(KERN_WARNING "atkbd.c: Spurious %s on %s. "
  346. "Some program might be trying access hardware directly.\n",
  347. data == ATKBD_RET_ACK ? "ACK" : "NAK", serio->phys);
  348. goto out;
  349. case ATKBD_RET_HANGEUL:
  350. case ATKBD_RET_HANJA:
  351. /*
  352. * These keys do not report release and thus need to be
  353. * flagged properly
  354. */
  355. add_release_event = 1;
  356. break;
  357. case ATKBD_RET_ERR:
  358. atkbd->err_count++;
  359. #ifdef ATKBD_DEBUG
  360. printk(KERN_DEBUG "atkbd.c: Keyboard on %s reports too many keys pressed.\n", serio->phys);
  361. #endif
  362. goto out;
  363. }
  364. code = atkbd_compat_scancode(atkbd, code);
  365. if (atkbd->emul && --atkbd->emul)
  366. goto out;
  367. keycode = atkbd->keycode[code];
  368. if (keycode != ATKBD_KEY_NULL)
  369. input_event(dev, EV_MSC, MSC_SCAN, code);
  370. switch (keycode) {
  371. case ATKBD_KEY_NULL:
  372. break;
  373. case ATKBD_KEY_UNKNOWN:
  374. printk(KERN_WARNING
  375. "atkbd.c: Unknown key %s (%s set %d, code %#x on %s).\n",
  376. atkbd->release ? "released" : "pressed",
  377. atkbd->translated ? "translated" : "raw",
  378. atkbd->set, code, serio->phys);
  379. printk(KERN_WARNING
  380. "atkbd.c: Use 'setkeycodes %s%02x <keycode>' to make it known.\n",
  381. code & 0x80 ? "e0" : "", code & 0x7f);
  382. input_sync(dev);
  383. break;
  384. case ATKBD_SCR_1:
  385. scroll = 1 - atkbd->release * 2;
  386. break;
  387. case ATKBD_SCR_2:
  388. scroll = 2 - atkbd->release * 4;
  389. break;
  390. case ATKBD_SCR_4:
  391. scroll = 4 - atkbd->release * 8;
  392. break;
  393. case ATKBD_SCR_8:
  394. scroll = 8 - atkbd->release * 16;
  395. break;
  396. case ATKBD_SCR_CLICK:
  397. click = !atkbd->release;
  398. break;
  399. case ATKBD_SCR_LEFT:
  400. hscroll = -1;
  401. break;
  402. case ATKBD_SCR_RIGHT:
  403. hscroll = 1;
  404. break;
  405. default:
  406. if (atkbd->release) {
  407. value = 0;
  408. atkbd->last = 0;
  409. } else if (!atkbd->softrepeat && test_bit(keycode, dev->key)) {
  410. /* Workaround Toshiba laptop multiple keypress */
  411. value = time_before(jiffies, atkbd->time) && atkbd->last == code ? 1 : 2;
  412. } else {
  413. value = 1;
  414. atkbd->last = code;
  415. atkbd->time = jiffies + msecs_to_jiffies(dev->rep[REP_DELAY]) / 2;
  416. }
  417. input_event(dev, EV_KEY, keycode, value);
  418. input_sync(dev);
  419. if (value && add_release_event) {
  420. input_report_key(dev, keycode, 0);
  421. input_sync(dev);
  422. }
  423. }
  424. if (atkbd->scroll) {
  425. if (click != -1)
  426. input_report_key(dev, BTN_MIDDLE, click);
  427. input_report_rel(dev, REL_WHEEL, scroll);
  428. input_report_rel(dev, REL_HWHEEL, hscroll);
  429. input_sync(dev);
  430. }
  431. atkbd->release = 0;
  432. out:
  433. return IRQ_HANDLED;
  434. }
  435. static int atkbd_set_repeat_rate(struct atkbd *atkbd)
  436. {
  437. const short period[32] =
  438. { 33, 37, 42, 46, 50, 54, 58, 63, 67, 75, 83, 92, 100, 109, 116, 125,
  439. 133, 149, 167, 182, 200, 217, 232, 250, 270, 303, 333, 370, 400, 435, 470, 500 };
  440. const short delay[4] =
  441. { 250, 500, 750, 1000 };
  442. struct input_dev *dev = atkbd->dev;
  443. unsigned char param;
  444. int i = 0, j = 0;
  445. while (i < ARRAY_SIZE(period) - 1 && period[i] < dev->rep[REP_PERIOD])
  446. i++;
  447. dev->rep[REP_PERIOD] = period[i];
  448. while (j < ARRAY_SIZE(delay) - 1 && delay[j] < dev->rep[REP_DELAY])
  449. j++;
  450. dev->rep[REP_DELAY] = delay[j];
  451. param = i | (j << 5);
  452. return ps2_command(&atkbd->ps2dev, &param, ATKBD_CMD_SETREP);
  453. }
  454. static int atkbd_set_leds(struct atkbd *atkbd)
  455. {
  456. struct input_dev *dev = atkbd->dev;
  457. unsigned char param[2];
  458. param[0] = (test_bit(LED_SCROLLL, dev->led) ? 1 : 0)
  459. | (test_bit(LED_NUML, dev->led) ? 2 : 0)
  460. | (test_bit(LED_CAPSL, dev->led) ? 4 : 0);
  461. if (ps2_command(&atkbd->ps2dev, param, ATKBD_CMD_SETLEDS))
  462. return -1;
  463. if (atkbd->extra) {
  464. param[0] = 0;
  465. param[1] = (test_bit(LED_COMPOSE, dev->led) ? 0x01 : 0)
  466. | (test_bit(LED_SLEEP, dev->led) ? 0x02 : 0)
  467. | (test_bit(LED_SUSPEND, dev->led) ? 0x04 : 0)
  468. | (test_bit(LED_MISC, dev->led) ? 0x10 : 0)
  469. | (test_bit(LED_MUTE, dev->led) ? 0x20 : 0);
  470. if (ps2_command(&atkbd->ps2dev, param, ATKBD_CMD_EX_SETLEDS))
  471. return -1;
  472. }
  473. return 0;
  474. }
  475. /*
  476. * atkbd_event_work() is used to complete processing of events that
  477. * can not be processed by input_event() which is often called from
  478. * interrupt context.
  479. */
  480. static void atkbd_event_work(struct work_struct *work)
  481. {
  482. struct atkbd *atkbd = container_of(work, struct atkbd, event_work);
  483. mutex_lock(&atkbd->event_mutex);
  484. if (test_and_clear_bit(ATKBD_LED_EVENT_BIT, &atkbd->event_mask))
  485. atkbd_set_leds(atkbd);
  486. if (test_and_clear_bit(ATKBD_REP_EVENT_BIT, &atkbd->event_mask))
  487. atkbd_set_repeat_rate(atkbd);
  488. mutex_unlock(&atkbd->event_mutex);
  489. }
  490. /*
  491. * Event callback from the input module. Events that change the state of
  492. * the hardware are processed here. If action can not be performed in
  493. * interrupt context it is offloaded to atkbd_event_work.
  494. */
  495. static int atkbd_event(struct input_dev *dev, unsigned int type, unsigned int code, int value)
  496. {
  497. struct atkbd *atkbd = dev->private;
  498. if (!atkbd->write)
  499. return -1;
  500. switch (type) {
  501. case EV_LED:
  502. set_bit(ATKBD_LED_EVENT_BIT, &atkbd->event_mask);
  503. wmb();
  504. schedule_work(&atkbd->event_work);
  505. return 0;
  506. case EV_REP:
  507. if (!atkbd->softrepeat) {
  508. set_bit(ATKBD_REP_EVENT_BIT, &atkbd->event_mask);
  509. wmb();
  510. schedule_work(&atkbd->event_work);
  511. }
  512. return 0;
  513. }
  514. return -1;
  515. }
  516. /*
  517. * atkbd_enable() signals that interrupt handler is allowed to
  518. * generate input events.
  519. */
  520. static inline void atkbd_enable(struct atkbd *atkbd)
  521. {
  522. serio_pause_rx(atkbd->ps2dev.serio);
  523. atkbd->enabled = 1;
  524. serio_continue_rx(atkbd->ps2dev.serio);
  525. }
  526. /*
  527. * atkbd_disable() tells input handler that all incoming data except
  528. * for ACKs and command response should be dropped.
  529. */
  530. static inline void atkbd_disable(struct atkbd *atkbd)
  531. {
  532. serio_pause_rx(atkbd->ps2dev.serio);
  533. atkbd->enabled = 0;
  534. serio_continue_rx(atkbd->ps2dev.serio);
  535. }
  536. /*
  537. * atkbd_probe() probes for an AT keyboard on a serio port.
  538. */
  539. static int atkbd_probe(struct atkbd *atkbd)
  540. {
  541. struct ps2dev *ps2dev = &atkbd->ps2dev;
  542. unsigned char param[2];
  543. /*
  544. * Some systems, where the bit-twiddling when testing the io-lines of the
  545. * controller may confuse the keyboard need a full reset of the keyboard. On
  546. * these systems the BIOS also usually doesn't do it for us.
  547. */
  548. if (atkbd_reset)
  549. if (ps2_command(ps2dev, NULL, ATKBD_CMD_RESET_BAT))
  550. printk(KERN_WARNING "atkbd.c: keyboard reset failed on %s\n", ps2dev->serio->phys);
  551. /*
  552. * Then we check the keyboard ID. We should get 0xab83 under normal conditions.
  553. * Some keyboards report different values, but the first byte is always 0xab or
  554. * 0xac. Some old AT keyboards don't report anything. If a mouse is connected, this
  555. * should make sure we don't try to set the LEDs on it.
  556. */
  557. param[0] = param[1] = 0xa5; /* initialize with invalid values */
  558. if (ps2_command(ps2dev, param, ATKBD_CMD_GETID)) {
  559. /*
  560. * If the get ID command failed, we check if we can at least set the LEDs on
  561. * the keyboard. This should work on every keyboard out there. It also turns
  562. * the LEDs off, which we want anyway.
  563. */
  564. param[0] = 0;
  565. if (ps2_command(ps2dev, param, ATKBD_CMD_SETLEDS))
  566. return -1;
  567. atkbd->id = 0xabba;
  568. return 0;
  569. }
  570. if (!ps2_is_keyboard_id(param[0]))
  571. return -1;
  572. atkbd->id = (param[0] << 8) | param[1];
  573. if (atkbd->id == 0xaca1 && atkbd->translated) {
  574. printk(KERN_ERR "atkbd.c: NCD terminal keyboards are only supported on non-translating\n");
  575. printk(KERN_ERR "atkbd.c: controllers. Use i8042.direct=1 to disable translation.\n");
  576. return -1;
  577. }
  578. return 0;
  579. }
  580. /*
  581. * atkbd_select_set checks if a keyboard has a working Set 3 support, and
  582. * sets it into that. Unfortunately there are keyboards that can be switched
  583. * to Set 3, but don't work well in that (BTC Multimedia ...)
  584. */
  585. static int atkbd_select_set(struct atkbd *atkbd, int target_set, int allow_extra)
  586. {
  587. struct ps2dev *ps2dev = &atkbd->ps2dev;
  588. unsigned char param[2];
  589. atkbd->extra = 0;
  590. /*
  591. * For known special keyboards we can go ahead and set the correct set.
  592. * We check for NCD PS/2 Sun, NorthGate OmniKey 101 and
  593. * IBM RapidAccess / IBM EzButton / Chicony KBP-8993 keyboards.
  594. */
  595. if (atkbd->translated)
  596. return 2;
  597. if (atkbd->id == 0xaca1) {
  598. param[0] = 3;
  599. ps2_command(ps2dev, param, ATKBD_CMD_SSCANSET);
  600. return 3;
  601. }
  602. if (allow_extra) {
  603. param[0] = 0x71;
  604. if (!ps2_command(ps2dev, param, ATKBD_CMD_EX_ENABLE)) {
  605. atkbd->extra = 1;
  606. return 2;
  607. }
  608. }
  609. if (target_set != 3)
  610. return 2;
  611. if (!ps2_command(ps2dev, param, ATKBD_CMD_OK_GETID)) {
  612. atkbd->id = param[0] << 8 | param[1];
  613. return 2;
  614. }
  615. param[0] = 3;
  616. if (ps2_command(ps2dev, param, ATKBD_CMD_SSCANSET))
  617. return 2;
  618. param[0] = 0;
  619. if (ps2_command(ps2dev, param, ATKBD_CMD_GSCANSET))
  620. return 2;
  621. if (param[0] != 3) {
  622. param[0] = 2;
  623. if (ps2_command(ps2dev, param, ATKBD_CMD_SSCANSET))
  624. return 2;
  625. }
  626. ps2_command(ps2dev, param, ATKBD_CMD_SETALL_MBR);
  627. return 3;
  628. }
  629. static int atkbd_activate(struct atkbd *atkbd)
  630. {
  631. struct ps2dev *ps2dev = &atkbd->ps2dev;
  632. unsigned char param[1];
  633. /*
  634. * Set the LEDs to a defined state.
  635. */
  636. param[0] = 0;
  637. if (ps2_command(ps2dev, param, ATKBD_CMD_SETLEDS))
  638. return -1;
  639. /*
  640. * Set autorepeat to fastest possible.
  641. */
  642. param[0] = 0;
  643. if (ps2_command(ps2dev, param, ATKBD_CMD_SETREP))
  644. return -1;
  645. /*
  646. * Enable the keyboard to receive keystrokes.
  647. */
  648. if (ps2_command(ps2dev, NULL, ATKBD_CMD_ENABLE)) {
  649. printk(KERN_ERR "atkbd.c: Failed to enable keyboard on %s\n",
  650. ps2dev->serio->phys);
  651. return -1;
  652. }
  653. return 0;
  654. }
  655. /*
  656. * atkbd_cleanup() restores the keyboard state so that BIOS is happy after a
  657. * reboot.
  658. */
  659. static void atkbd_cleanup(struct serio *serio)
  660. {
  661. struct atkbd *atkbd = serio_get_drvdata(serio);
  662. ps2_command(&atkbd->ps2dev, NULL, ATKBD_CMD_RESET_BAT);
  663. }
  664. /*
  665. * atkbd_disconnect() closes and frees.
  666. */
  667. static void atkbd_disconnect(struct serio *serio)
  668. {
  669. struct atkbd *atkbd = serio_get_drvdata(serio);
  670. atkbd_disable(atkbd);
  671. /* make sure we don't have a command in flight */
  672. synchronize_sched(); /* Allow atkbd_interrupt()s to complete. */
  673. flush_scheduled_work();
  674. sysfs_remove_group(&serio->dev.kobj, &atkbd_attribute_group);
  675. input_unregister_device(atkbd->dev);
  676. serio_close(serio);
  677. serio_set_drvdata(serio, NULL);
  678. kfree(atkbd);
  679. }
  680. /*
  681. * atkbd_set_keycode_table() initializes keyboard's keycode table
  682. * according to the selected scancode set
  683. */
  684. static void atkbd_set_keycode_table(struct atkbd *atkbd)
  685. {
  686. int i, j;
  687. memset(atkbd->keycode, 0, sizeof(atkbd->keycode));
  688. if (atkbd->translated) {
  689. for (i = 0; i < 128; i++) {
  690. atkbd->keycode[i] = atkbd_set2_keycode[atkbd_unxlate_table[i]];
  691. atkbd->keycode[i | 0x80] = atkbd_set2_keycode[atkbd_unxlate_table[i] | 0x80];
  692. if (atkbd->scroll)
  693. for (j = 0; j < ARRAY_SIZE(atkbd_scroll_keys); j++)
  694. if ((atkbd_unxlate_table[i] | 0x80) == atkbd_scroll_keys[j].set2)
  695. atkbd->keycode[i | 0x80] = atkbd_scroll_keys[j].keycode;
  696. }
  697. } else if (atkbd->set == 3) {
  698. memcpy(atkbd->keycode, atkbd_set3_keycode, sizeof(atkbd->keycode));
  699. } else {
  700. memcpy(atkbd->keycode, atkbd_set2_keycode, sizeof(atkbd->keycode));
  701. if (atkbd->scroll)
  702. for (i = 0; i < ARRAY_SIZE(atkbd_scroll_keys); i++)
  703. atkbd->keycode[atkbd_scroll_keys[i].set2] = atkbd_scroll_keys[i].keycode;
  704. }
  705. atkbd->keycode[atkbd_compat_scancode(atkbd, ATKBD_RET_HANGEUL)] = KEY_HANGUEL;
  706. atkbd->keycode[atkbd_compat_scancode(atkbd, ATKBD_RET_HANJA)] = KEY_HANJA;
  707. }
  708. /*
  709. * atkbd_set_device_attrs() sets up keyboard's input device structure
  710. */
  711. static void atkbd_set_device_attrs(struct atkbd *atkbd)
  712. {
  713. struct input_dev *input_dev = atkbd->dev;
  714. int i;
  715. if (atkbd->extra)
  716. snprintf(atkbd->name, sizeof(atkbd->name),
  717. "AT Set 2 Extra keyboard");
  718. else
  719. snprintf(atkbd->name, sizeof(atkbd->name),
  720. "AT %s Set %d keyboard",
  721. atkbd->translated ? "Translated" : "Raw", atkbd->set);
  722. snprintf(atkbd->phys, sizeof(atkbd->phys),
  723. "%s/input0", atkbd->ps2dev.serio->phys);
  724. input_dev->name = atkbd->name;
  725. input_dev->phys = atkbd->phys;
  726. input_dev->id.bustype = BUS_I8042;
  727. input_dev->id.vendor = 0x0001;
  728. input_dev->id.product = atkbd->translated ? 1 : atkbd->set;
  729. input_dev->id.version = atkbd->id;
  730. input_dev->event = atkbd_event;
  731. input_dev->private = atkbd;
  732. input_dev->cdev.dev = &atkbd->ps2dev.serio->dev;
  733. input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REP) | BIT(EV_MSC);
  734. if (atkbd->write) {
  735. input_dev->evbit[0] |= BIT(EV_LED);
  736. input_dev->ledbit[0] = BIT(LED_NUML) | BIT(LED_CAPSL) | BIT(LED_SCROLLL);
  737. }
  738. if (atkbd->extra)
  739. input_dev->ledbit[0] |= BIT(LED_COMPOSE) | BIT(LED_SUSPEND) |
  740. BIT(LED_SLEEP) | BIT(LED_MUTE) | BIT(LED_MISC);
  741. if (!atkbd->softrepeat) {
  742. input_dev->rep[REP_DELAY] = 250;
  743. input_dev->rep[REP_PERIOD] = 33;
  744. }
  745. input_dev->mscbit[0] = atkbd->softraw ? BIT(MSC_SCAN) : BIT(MSC_RAW) | BIT(MSC_SCAN);
  746. if (atkbd->scroll) {
  747. input_dev->evbit[0] |= BIT(EV_REL);
  748. input_dev->relbit[0] = BIT(REL_WHEEL) | BIT(REL_HWHEEL);
  749. set_bit(BTN_MIDDLE, input_dev->keybit);
  750. }
  751. input_dev->keycode = atkbd->keycode;
  752. input_dev->keycodesize = sizeof(unsigned char);
  753. input_dev->keycodemax = ARRAY_SIZE(atkbd_set2_keycode);
  754. for (i = 0; i < 512; i++)
  755. if (atkbd->keycode[i] && atkbd->keycode[i] < ATKBD_SPECIAL)
  756. set_bit(atkbd->keycode[i], input_dev->keybit);
  757. }
  758. /*
  759. * atkbd_connect() is called when the serio module finds an interface
  760. * that isn't handled yet by an appropriate device driver. We check if
  761. * there is an AT keyboard out there and if yes, we register ourselves
  762. * to the input module.
  763. */
  764. static int atkbd_connect(struct serio *serio, struct serio_driver *drv)
  765. {
  766. struct atkbd *atkbd;
  767. struct input_dev *dev;
  768. int err = -ENOMEM;
  769. atkbd = kzalloc(sizeof(struct atkbd), GFP_KERNEL);
  770. dev = input_allocate_device();
  771. if (!atkbd || !dev)
  772. goto fail1;
  773. atkbd->dev = dev;
  774. ps2_init(&atkbd->ps2dev, serio);
  775. INIT_WORK(&atkbd->event_work, atkbd_event_work);
  776. mutex_init(&atkbd->event_mutex);
  777. switch (serio->id.type) {
  778. case SERIO_8042_XL:
  779. atkbd->translated = 1;
  780. case SERIO_8042:
  781. if (serio->write)
  782. atkbd->write = 1;
  783. break;
  784. }
  785. atkbd->softraw = atkbd_softraw;
  786. atkbd->softrepeat = atkbd_softrepeat;
  787. atkbd->scroll = atkbd_scroll;
  788. if (atkbd->softrepeat)
  789. atkbd->softraw = 1;
  790. serio_set_drvdata(serio, atkbd);
  791. err = serio_open(serio, drv);
  792. if (err)
  793. goto fail2;
  794. if (atkbd->write) {
  795. if (atkbd_probe(atkbd)) {
  796. err = -ENODEV;
  797. goto fail3;
  798. }
  799. atkbd->set = atkbd_select_set(atkbd, atkbd_set, atkbd_extra);
  800. atkbd_activate(atkbd);
  801. } else {
  802. atkbd->set = 2;
  803. atkbd->id = 0xab00;
  804. }
  805. atkbd_set_keycode_table(atkbd);
  806. atkbd_set_device_attrs(atkbd);
  807. err = sysfs_create_group(&serio->dev.kobj, &atkbd_attribute_group);
  808. if (err)
  809. goto fail3;
  810. atkbd_enable(atkbd);
  811. err = input_register_device(atkbd->dev);
  812. if (err)
  813. goto fail4;
  814. return 0;
  815. fail4: sysfs_remove_group(&serio->dev.kobj, &atkbd_attribute_group);
  816. fail3: serio_close(serio);
  817. fail2: serio_set_drvdata(serio, NULL);
  818. fail1: input_free_device(dev);
  819. kfree(atkbd);
  820. return err;
  821. }
  822. /*
  823. * atkbd_reconnect() tries to restore keyboard into a sane state and is
  824. * most likely called on resume.
  825. */
  826. static int atkbd_reconnect(struct serio *serio)
  827. {
  828. struct atkbd *atkbd = serio_get_drvdata(serio);
  829. struct serio_driver *drv = serio->drv;
  830. if (!atkbd || !drv) {
  831. printk(KERN_DEBUG "atkbd: reconnect request, but serio is disconnected, ignoring...\n");
  832. return -1;
  833. }
  834. atkbd_disable(atkbd);
  835. if (atkbd->write) {
  836. if (atkbd_probe(atkbd))
  837. return -1;
  838. if (atkbd->set != atkbd_select_set(atkbd, atkbd->set, atkbd->extra))
  839. return -1;
  840. atkbd_activate(atkbd);
  841. /*
  842. * Restore repeat rate and LEDs (that were reset by atkbd_activate)
  843. * to pre-resume state
  844. */
  845. if (!atkbd->softrepeat)
  846. atkbd_set_repeat_rate(atkbd);
  847. atkbd_set_leds(atkbd);
  848. }
  849. atkbd_enable(atkbd);
  850. return 0;
  851. }
  852. static struct serio_device_id atkbd_serio_ids[] = {
  853. {
  854. .type = SERIO_8042,
  855. .proto = SERIO_ANY,
  856. .id = SERIO_ANY,
  857. .extra = SERIO_ANY,
  858. },
  859. {
  860. .type = SERIO_8042_XL,
  861. .proto = SERIO_ANY,
  862. .id = SERIO_ANY,
  863. .extra = SERIO_ANY,
  864. },
  865. {
  866. .type = SERIO_RS232,
  867. .proto = SERIO_PS2SER,
  868. .id = SERIO_ANY,
  869. .extra = SERIO_ANY,
  870. },
  871. { 0 }
  872. };
  873. MODULE_DEVICE_TABLE(serio, atkbd_serio_ids);
  874. static struct serio_driver atkbd_drv = {
  875. .driver = {
  876. .name = "atkbd",
  877. },
  878. .description = DRIVER_DESC,
  879. .id_table = atkbd_serio_ids,
  880. .interrupt = atkbd_interrupt,
  881. .connect = atkbd_connect,
  882. .reconnect = atkbd_reconnect,
  883. .disconnect = atkbd_disconnect,
  884. .cleanup = atkbd_cleanup,
  885. };
  886. static ssize_t atkbd_attr_show_helper(struct device *dev, char *buf,
  887. ssize_t (*handler)(struct atkbd *, char *))
  888. {
  889. struct serio *serio = to_serio_port(dev);
  890. int retval;
  891. retval = serio_pin_driver(serio);
  892. if (retval)
  893. return retval;
  894. if (serio->drv != &atkbd_drv) {
  895. retval = -ENODEV;
  896. goto out;
  897. }
  898. retval = handler((struct atkbd *)serio_get_drvdata(serio), buf);
  899. out:
  900. serio_unpin_driver(serio);
  901. return retval;
  902. }
  903. static ssize_t atkbd_attr_set_helper(struct device *dev, const char *buf, size_t count,
  904. ssize_t (*handler)(struct atkbd *, const char *, size_t))
  905. {
  906. struct serio *serio = to_serio_port(dev);
  907. struct atkbd *atkbd;
  908. int retval;
  909. retval = serio_pin_driver(serio);
  910. if (retval)
  911. return retval;
  912. if (serio->drv != &atkbd_drv) {
  913. retval = -ENODEV;
  914. goto out;
  915. }
  916. atkbd = serio_get_drvdata(serio);
  917. atkbd_disable(atkbd);
  918. retval = handler(atkbd, buf, count);
  919. atkbd_enable(atkbd);
  920. out:
  921. serio_unpin_driver(serio);
  922. return retval;
  923. }
  924. static ssize_t atkbd_show_extra(struct atkbd *atkbd, char *buf)
  925. {
  926. return sprintf(buf, "%d\n", atkbd->extra ? 1 : 0);
  927. }
  928. static ssize_t atkbd_set_extra(struct atkbd *atkbd, const char *buf, size_t count)
  929. {
  930. struct input_dev *old_dev, *new_dev;
  931. unsigned long value;
  932. char *rest;
  933. int err;
  934. unsigned char old_extra, old_set;
  935. if (!atkbd->write)
  936. return -EIO;
  937. value = simple_strtoul(buf, &rest, 10);
  938. if (*rest || value > 1)
  939. return -EINVAL;
  940. if (atkbd->extra != value) {
  941. /*
  942. * Since device's properties will change we need to
  943. * unregister old device. But allocate and register
  944. * new one first to make sure we have it.
  945. */
  946. old_dev = atkbd->dev;
  947. old_extra = atkbd->extra;
  948. old_set = atkbd->set;
  949. new_dev = input_allocate_device();
  950. if (!new_dev)
  951. return -ENOMEM;
  952. atkbd->dev = new_dev;
  953. atkbd->set = atkbd_select_set(atkbd, atkbd->set, value);
  954. atkbd_activate(atkbd);
  955. atkbd_set_keycode_table(atkbd);
  956. atkbd_set_device_attrs(atkbd);
  957. err = input_register_device(atkbd->dev);
  958. if (err) {
  959. input_free_device(new_dev);
  960. atkbd->dev = old_dev;
  961. atkbd->set = atkbd_select_set(atkbd, old_set, old_extra);
  962. atkbd_set_keycode_table(atkbd);
  963. atkbd_set_device_attrs(atkbd);
  964. return err;
  965. }
  966. input_unregister_device(old_dev);
  967. }
  968. return count;
  969. }
  970. static ssize_t atkbd_show_scroll(struct atkbd *atkbd, char *buf)
  971. {
  972. return sprintf(buf, "%d\n", atkbd->scroll ? 1 : 0);
  973. }
  974. static ssize_t atkbd_set_scroll(struct atkbd *atkbd, const char *buf, size_t count)
  975. {
  976. struct input_dev *old_dev, *new_dev;
  977. unsigned long value;
  978. char *rest;
  979. int err;
  980. unsigned char old_scroll;
  981. value = simple_strtoul(buf, &rest, 10);
  982. if (*rest || value > 1)
  983. return -EINVAL;
  984. if (atkbd->scroll != value) {
  985. old_dev = atkbd->dev;
  986. old_scroll = atkbd->scroll;
  987. new_dev = input_allocate_device();
  988. if (!new_dev)
  989. return -ENOMEM;
  990. atkbd->dev = new_dev;
  991. atkbd->scroll = value;
  992. atkbd_set_keycode_table(atkbd);
  993. atkbd_set_device_attrs(atkbd);
  994. err = input_register_device(atkbd->dev);
  995. if (err) {
  996. input_free_device(new_dev);
  997. atkbd->scroll = old_scroll;
  998. atkbd->dev = old_dev;
  999. atkbd_set_keycode_table(atkbd);
  1000. atkbd_set_device_attrs(atkbd);
  1001. return err;
  1002. }
  1003. input_unregister_device(old_dev);
  1004. }
  1005. return count;
  1006. }
  1007. static ssize_t atkbd_show_set(struct atkbd *atkbd, char *buf)
  1008. {
  1009. return sprintf(buf, "%d\n", atkbd->set);
  1010. }
  1011. static ssize_t atkbd_set_set(struct atkbd *atkbd, const char *buf, size_t count)
  1012. {
  1013. struct input_dev *old_dev, *new_dev;
  1014. unsigned long value;
  1015. char *rest;
  1016. int err;
  1017. unsigned char old_set, old_extra;
  1018. if (!atkbd->write)
  1019. return -EIO;
  1020. value = simple_strtoul(buf, &rest, 10);
  1021. if (*rest || (value != 2 && value != 3))
  1022. return -EINVAL;
  1023. if (atkbd->set != value) {
  1024. old_dev = atkbd->dev;
  1025. old_extra = atkbd->extra;
  1026. old_set = atkbd->set;
  1027. new_dev = input_allocate_device();
  1028. if (!new_dev)
  1029. return -ENOMEM;
  1030. atkbd->dev = new_dev;
  1031. atkbd->set = atkbd_select_set(atkbd, value, atkbd->extra);
  1032. atkbd_activate(atkbd);
  1033. atkbd_set_keycode_table(atkbd);
  1034. atkbd_set_device_attrs(atkbd);
  1035. err = input_register_device(atkbd->dev);
  1036. if (err) {
  1037. input_free_device(new_dev);
  1038. atkbd->dev = old_dev;
  1039. atkbd->set = atkbd_select_set(atkbd, old_set, old_extra);
  1040. atkbd_set_keycode_table(atkbd);
  1041. atkbd_set_device_attrs(atkbd);
  1042. return err;
  1043. }
  1044. input_unregister_device(old_dev);
  1045. }
  1046. return count;
  1047. }
  1048. static ssize_t atkbd_show_softrepeat(struct atkbd *atkbd, char *buf)
  1049. {
  1050. return sprintf(buf, "%d\n", atkbd->softrepeat ? 1 : 0);
  1051. }
  1052. static ssize_t atkbd_set_softrepeat(struct atkbd *atkbd, const char *buf, size_t count)
  1053. {
  1054. struct input_dev *old_dev, *new_dev;
  1055. unsigned long value;
  1056. char *rest;
  1057. int err;
  1058. unsigned char old_softrepeat, old_softraw;
  1059. if (!atkbd->write)
  1060. return -EIO;
  1061. value = simple_strtoul(buf, &rest, 10);
  1062. if (*rest || value > 1)
  1063. return -EINVAL;
  1064. if (atkbd->softrepeat != value) {
  1065. old_dev = atkbd->dev;
  1066. old_softrepeat = atkbd->softrepeat;
  1067. old_softraw = atkbd->softraw;
  1068. new_dev = input_allocate_device();
  1069. if (!new_dev)
  1070. return -ENOMEM;
  1071. atkbd->dev = new_dev;
  1072. atkbd->softrepeat = value;
  1073. if (atkbd->softrepeat)
  1074. atkbd->softraw = 1;
  1075. atkbd_set_device_attrs(atkbd);
  1076. err = input_register_device(atkbd->dev);
  1077. if (err) {
  1078. input_free_device(new_dev);
  1079. atkbd->dev = old_dev;
  1080. atkbd->softrepeat = old_softrepeat;
  1081. atkbd->softraw = old_softraw;
  1082. atkbd_set_device_attrs(atkbd);
  1083. return err;
  1084. }
  1085. input_unregister_device(old_dev);
  1086. }
  1087. return count;
  1088. }
  1089. static ssize_t atkbd_show_softraw(struct atkbd *atkbd, char *buf)
  1090. {
  1091. return sprintf(buf, "%d\n", atkbd->softraw ? 1 : 0);
  1092. }
  1093. static ssize_t atkbd_set_softraw(struct atkbd *atkbd, const char *buf, size_t count)
  1094. {
  1095. struct input_dev *old_dev, *new_dev;
  1096. unsigned long value;
  1097. char *rest;
  1098. int err;
  1099. unsigned char old_softraw;
  1100. value = simple_strtoul(buf, &rest, 10);
  1101. if (*rest || value > 1)
  1102. return -EINVAL;
  1103. if (atkbd->softraw != value) {
  1104. old_dev = atkbd->dev;
  1105. old_softraw = atkbd->softraw;
  1106. new_dev = input_allocate_device();
  1107. if (!new_dev)
  1108. return -ENOMEM;
  1109. atkbd->dev = new_dev;
  1110. atkbd->softraw = value;
  1111. atkbd_set_device_attrs(atkbd);
  1112. err = input_register_device(atkbd->dev);
  1113. if (err) {
  1114. input_free_device(new_dev);
  1115. atkbd->dev = old_dev;
  1116. atkbd->softraw = old_softraw;
  1117. atkbd_set_device_attrs(atkbd);
  1118. return err;
  1119. }
  1120. input_unregister_device(old_dev);
  1121. }
  1122. return count;
  1123. }
  1124. static ssize_t atkbd_show_err_count(struct atkbd *atkbd, char *buf)
  1125. {
  1126. return sprintf(buf, "%lu\n", atkbd->err_count);
  1127. }
  1128. static int __init atkbd_init(void)
  1129. {
  1130. return serio_register_driver(&atkbd_drv);
  1131. }
  1132. static void __exit atkbd_exit(void)
  1133. {
  1134. serio_unregister_driver(&atkbd_drv);
  1135. }
  1136. module_init(atkbd_init);
  1137. module_exit(atkbd_exit);