consolemap.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669
  1. /*
  2. * consolemap.c
  3. *
  4. * Mapping from internal code (such as Latin-1 or Unicode or IBM PC code)
  5. * to font positions.
  6. *
  7. * aeb, 950210
  8. *
  9. * Support for multiple unimaps by Jakub Jelinek <jj@ultra.linux.cz>, July 1998
  10. *
  11. * Fix bug in inverse translation. Stanislav Voronyi <stas@cnti.uanet.kharkov.ua>, Dec 1998
  12. */
  13. #include <linux/module.h>
  14. #include <linux/kd.h>
  15. #include <linux/errno.h>
  16. #include <linux/mm.h>
  17. #include <linux/slab.h>
  18. #include <linux/init.h>
  19. #include <linux/tty.h>
  20. #include <asm/uaccess.h>
  21. #include <linux/consolemap.h>
  22. #include <linux/vt_kern.h>
  23. static unsigned short translations[][256] = {
  24. /* 8-bit Latin-1 mapped to Unicode -- trivial mapping */
  25. {
  26. 0x0000, 0x0001, 0x0002, 0x0003, 0x0004, 0x0005, 0x0006, 0x0007,
  27. 0x0008, 0x0009, 0x000a, 0x000b, 0x000c, 0x000d, 0x000e, 0x000f,
  28. 0x0010, 0x0011, 0x0012, 0x0013, 0x0014, 0x0015, 0x0016, 0x0017,
  29. 0x0018, 0x0019, 0x001a, 0x001b, 0x001c, 0x001d, 0x001e, 0x001f,
  30. 0x0020, 0x0021, 0x0022, 0x0023, 0x0024, 0x0025, 0x0026, 0x0027,
  31. 0x0028, 0x0029, 0x002a, 0x002b, 0x002c, 0x002d, 0x002e, 0x002f,
  32. 0x0030, 0x0031, 0x0032, 0x0033, 0x0034, 0x0035, 0x0036, 0x0037,
  33. 0x0038, 0x0039, 0x003a, 0x003b, 0x003c, 0x003d, 0x003e, 0x003f,
  34. 0x0040, 0x0041, 0x0042, 0x0043, 0x0044, 0x0045, 0x0046, 0x0047,
  35. 0x0048, 0x0049, 0x004a, 0x004b, 0x004c, 0x004d, 0x004e, 0x004f,
  36. 0x0050, 0x0051, 0x0052, 0x0053, 0x0054, 0x0055, 0x0056, 0x0057,
  37. 0x0058, 0x0059, 0x005a, 0x005b, 0x005c, 0x005d, 0x005e, 0x005f,
  38. 0x0060, 0x0061, 0x0062, 0x0063, 0x0064, 0x0065, 0x0066, 0x0067,
  39. 0x0068, 0x0069, 0x006a, 0x006b, 0x006c, 0x006d, 0x006e, 0x006f,
  40. 0x0070, 0x0071, 0x0072, 0x0073, 0x0074, 0x0075, 0x0076, 0x0077,
  41. 0x0078, 0x0079, 0x007a, 0x007b, 0x007c, 0x007d, 0x007e, 0x007f,
  42. 0x0080, 0x0081, 0x0082, 0x0083, 0x0084, 0x0085, 0x0086, 0x0087,
  43. 0x0088, 0x0089, 0x008a, 0x008b, 0x008c, 0x008d, 0x008e, 0x008f,
  44. 0x0090, 0x0091, 0x0092, 0x0093, 0x0094, 0x0095, 0x0096, 0x0097,
  45. 0x0098, 0x0099, 0x009a, 0x009b, 0x009c, 0x009d, 0x009e, 0x009f,
  46. 0x00a0, 0x00a1, 0x00a2, 0x00a3, 0x00a4, 0x00a5, 0x00a6, 0x00a7,
  47. 0x00a8, 0x00a9, 0x00aa, 0x00ab, 0x00ac, 0x00ad, 0x00ae, 0x00af,
  48. 0x00b0, 0x00b1, 0x00b2, 0x00b3, 0x00b4, 0x00b5, 0x00b6, 0x00b7,
  49. 0x00b8, 0x00b9, 0x00ba, 0x00bb, 0x00bc, 0x00bd, 0x00be, 0x00bf,
  50. 0x00c0, 0x00c1, 0x00c2, 0x00c3, 0x00c4, 0x00c5, 0x00c6, 0x00c7,
  51. 0x00c8, 0x00c9, 0x00ca, 0x00cb, 0x00cc, 0x00cd, 0x00ce, 0x00cf,
  52. 0x00d0, 0x00d1, 0x00d2, 0x00d3, 0x00d4, 0x00d5, 0x00d6, 0x00d7,
  53. 0x00d8, 0x00d9, 0x00da, 0x00db, 0x00dc, 0x00dd, 0x00de, 0x00df,
  54. 0x00e0, 0x00e1, 0x00e2, 0x00e3, 0x00e4, 0x00e5, 0x00e6, 0x00e7,
  55. 0x00e8, 0x00e9, 0x00ea, 0x00eb, 0x00ec, 0x00ed, 0x00ee, 0x00ef,
  56. 0x00f0, 0x00f1, 0x00f2, 0x00f3, 0x00f4, 0x00f5, 0x00f6, 0x00f7,
  57. 0x00f8, 0x00f9, 0x00fa, 0x00fb, 0x00fc, 0x00fd, 0x00fe, 0x00ff
  58. },
  59. /* VT100 graphics mapped to Unicode */
  60. {
  61. 0x0000, 0x0001, 0x0002, 0x0003, 0x0004, 0x0005, 0x0006, 0x0007,
  62. 0x0008, 0x0009, 0x000a, 0x000b, 0x000c, 0x000d, 0x000e, 0x000f,
  63. 0x0010, 0x0011, 0x0012, 0x0013, 0x0014, 0x0015, 0x0016, 0x0017,
  64. 0x0018, 0x0019, 0x001a, 0x001b, 0x001c, 0x001d, 0x001e, 0x001f,
  65. 0x0020, 0x0021, 0x0022, 0x0023, 0x0024, 0x0025, 0x0026, 0x0027,
  66. 0x0028, 0x0029, 0x002a, 0x2192, 0x2190, 0x2191, 0x2193, 0x002f,
  67. 0x2588, 0x0031, 0x0032, 0x0033, 0x0034, 0x0035, 0x0036, 0x0037,
  68. 0x0038, 0x0039, 0x003a, 0x003b, 0x003c, 0x003d, 0x003e, 0x003f,
  69. 0x0040, 0x0041, 0x0042, 0x0043, 0x0044, 0x0045, 0x0046, 0x0047,
  70. 0x0048, 0x0049, 0x004a, 0x004b, 0x004c, 0x004d, 0x004e, 0x004f,
  71. 0x0050, 0x0051, 0x0052, 0x0053, 0x0054, 0x0055, 0x0056, 0x0057,
  72. 0x0058, 0x0059, 0x005a, 0x005b, 0x005c, 0x005d, 0x005e, 0x00a0,
  73. 0x25c6, 0x2592, 0x2409, 0x240c, 0x240d, 0x240a, 0x00b0, 0x00b1,
  74. 0x2591, 0x240b, 0x2518, 0x2510, 0x250c, 0x2514, 0x253c, 0x23ba,
  75. 0x23bb, 0x2500, 0x23bc, 0x23bd, 0x251c, 0x2524, 0x2534, 0x252c,
  76. 0x2502, 0x2264, 0x2265, 0x03c0, 0x2260, 0x00a3, 0x00b7, 0x007f,
  77. 0x0080, 0x0081, 0x0082, 0x0083, 0x0084, 0x0085, 0x0086, 0x0087,
  78. 0x0088, 0x0089, 0x008a, 0x008b, 0x008c, 0x008d, 0x008e, 0x008f,
  79. 0x0090, 0x0091, 0x0092, 0x0093, 0x0094, 0x0095, 0x0096, 0x0097,
  80. 0x0098, 0x0099, 0x009a, 0x009b, 0x009c, 0x009d, 0x009e, 0x009f,
  81. 0x00a0, 0x00a1, 0x00a2, 0x00a3, 0x00a4, 0x00a5, 0x00a6, 0x00a7,
  82. 0x00a8, 0x00a9, 0x00aa, 0x00ab, 0x00ac, 0x00ad, 0x00ae, 0x00af,
  83. 0x00b0, 0x00b1, 0x00b2, 0x00b3, 0x00b4, 0x00b5, 0x00b6, 0x00b7,
  84. 0x00b8, 0x00b9, 0x00ba, 0x00bb, 0x00bc, 0x00bd, 0x00be, 0x00bf,
  85. 0x00c0, 0x00c1, 0x00c2, 0x00c3, 0x00c4, 0x00c5, 0x00c6, 0x00c7,
  86. 0x00c8, 0x00c9, 0x00ca, 0x00cb, 0x00cc, 0x00cd, 0x00ce, 0x00cf,
  87. 0x00d0, 0x00d1, 0x00d2, 0x00d3, 0x00d4, 0x00d5, 0x00d6, 0x00d7,
  88. 0x00d8, 0x00d9, 0x00da, 0x00db, 0x00dc, 0x00dd, 0x00de, 0x00df,
  89. 0x00e0, 0x00e1, 0x00e2, 0x00e3, 0x00e4, 0x00e5, 0x00e6, 0x00e7,
  90. 0x00e8, 0x00e9, 0x00ea, 0x00eb, 0x00ec, 0x00ed, 0x00ee, 0x00ef,
  91. 0x00f0, 0x00f1, 0x00f2, 0x00f3, 0x00f4, 0x00f5, 0x00f6, 0x00f7,
  92. 0x00f8, 0x00f9, 0x00fa, 0x00fb, 0x00fc, 0x00fd, 0x00fe, 0x00ff
  93. },
  94. /* IBM Codepage 437 mapped to Unicode */
  95. {
  96. 0x0000, 0x263a, 0x263b, 0x2665, 0x2666, 0x2663, 0x2660, 0x2022,
  97. 0x25d8, 0x25cb, 0x25d9, 0x2642, 0x2640, 0x266a, 0x266b, 0x263c,
  98. 0x25b6, 0x25c0, 0x2195, 0x203c, 0x00b6, 0x00a7, 0x25ac, 0x21a8,
  99. 0x2191, 0x2193, 0x2192, 0x2190, 0x221f, 0x2194, 0x25b2, 0x25bc,
  100. 0x0020, 0x0021, 0x0022, 0x0023, 0x0024, 0x0025, 0x0026, 0x0027,
  101. 0x0028, 0x0029, 0x002a, 0x002b, 0x002c, 0x002d, 0x002e, 0x002f,
  102. 0x0030, 0x0031, 0x0032, 0x0033, 0x0034, 0x0035, 0x0036, 0x0037,
  103. 0x0038, 0x0039, 0x003a, 0x003b, 0x003c, 0x003d, 0x003e, 0x003f,
  104. 0x0040, 0x0041, 0x0042, 0x0043, 0x0044, 0x0045, 0x0046, 0x0047,
  105. 0x0048, 0x0049, 0x004a, 0x004b, 0x004c, 0x004d, 0x004e, 0x004f,
  106. 0x0050, 0x0051, 0x0052, 0x0053, 0x0054, 0x0055, 0x0056, 0x0057,
  107. 0x0058, 0x0059, 0x005a, 0x005b, 0x005c, 0x005d, 0x005e, 0x005f,
  108. 0x0060, 0x0061, 0x0062, 0x0063, 0x0064, 0x0065, 0x0066, 0x0067,
  109. 0x0068, 0x0069, 0x006a, 0x006b, 0x006c, 0x006d, 0x006e, 0x006f,
  110. 0x0070, 0x0071, 0x0072, 0x0073, 0x0074, 0x0075, 0x0076, 0x0077,
  111. 0x0078, 0x0079, 0x007a, 0x007b, 0x007c, 0x007d, 0x007e, 0x2302,
  112. 0x00c7, 0x00fc, 0x00e9, 0x00e2, 0x00e4, 0x00e0, 0x00e5, 0x00e7,
  113. 0x00ea, 0x00eb, 0x00e8, 0x00ef, 0x00ee, 0x00ec, 0x00c4, 0x00c5,
  114. 0x00c9, 0x00e6, 0x00c6, 0x00f4, 0x00f6, 0x00f2, 0x00fb, 0x00f9,
  115. 0x00ff, 0x00d6, 0x00dc, 0x00a2, 0x00a3, 0x00a5, 0x20a7, 0x0192,
  116. 0x00e1, 0x00ed, 0x00f3, 0x00fa, 0x00f1, 0x00d1, 0x00aa, 0x00ba,
  117. 0x00bf, 0x2310, 0x00ac, 0x00bd, 0x00bc, 0x00a1, 0x00ab, 0x00bb,
  118. 0x2591, 0x2592, 0x2593, 0x2502, 0x2524, 0x2561, 0x2562, 0x2556,
  119. 0x2555, 0x2563, 0x2551, 0x2557, 0x255d, 0x255c, 0x255b, 0x2510,
  120. 0x2514, 0x2534, 0x252c, 0x251c, 0x2500, 0x253c, 0x255e, 0x255f,
  121. 0x255a, 0x2554, 0x2569, 0x2566, 0x2560, 0x2550, 0x256c, 0x2567,
  122. 0x2568, 0x2564, 0x2565, 0x2559, 0x2558, 0x2552, 0x2553, 0x256b,
  123. 0x256a, 0x2518, 0x250c, 0x2588, 0x2584, 0x258c, 0x2590, 0x2580,
  124. 0x03b1, 0x00df, 0x0393, 0x03c0, 0x03a3, 0x03c3, 0x00b5, 0x03c4,
  125. 0x03a6, 0x0398, 0x03a9, 0x03b4, 0x221e, 0x03c6, 0x03b5, 0x2229,
  126. 0x2261, 0x00b1, 0x2265, 0x2264, 0x2320, 0x2321, 0x00f7, 0x2248,
  127. 0x00b0, 0x2219, 0x00b7, 0x221a, 0x207f, 0x00b2, 0x25a0, 0x00a0
  128. },
  129. /* User mapping -- default to codes for direct font mapping */
  130. {
  131. 0xf000, 0xf001, 0xf002, 0xf003, 0xf004, 0xf005, 0xf006, 0xf007,
  132. 0xf008, 0xf009, 0xf00a, 0xf00b, 0xf00c, 0xf00d, 0xf00e, 0xf00f,
  133. 0xf010, 0xf011, 0xf012, 0xf013, 0xf014, 0xf015, 0xf016, 0xf017,
  134. 0xf018, 0xf019, 0xf01a, 0xf01b, 0xf01c, 0xf01d, 0xf01e, 0xf01f,
  135. 0xf020, 0xf021, 0xf022, 0xf023, 0xf024, 0xf025, 0xf026, 0xf027,
  136. 0xf028, 0xf029, 0xf02a, 0xf02b, 0xf02c, 0xf02d, 0xf02e, 0xf02f,
  137. 0xf030, 0xf031, 0xf032, 0xf033, 0xf034, 0xf035, 0xf036, 0xf037,
  138. 0xf038, 0xf039, 0xf03a, 0xf03b, 0xf03c, 0xf03d, 0xf03e, 0xf03f,
  139. 0xf040, 0xf041, 0xf042, 0xf043, 0xf044, 0xf045, 0xf046, 0xf047,
  140. 0xf048, 0xf049, 0xf04a, 0xf04b, 0xf04c, 0xf04d, 0xf04e, 0xf04f,
  141. 0xf050, 0xf051, 0xf052, 0xf053, 0xf054, 0xf055, 0xf056, 0xf057,
  142. 0xf058, 0xf059, 0xf05a, 0xf05b, 0xf05c, 0xf05d, 0xf05e, 0xf05f,
  143. 0xf060, 0xf061, 0xf062, 0xf063, 0xf064, 0xf065, 0xf066, 0xf067,
  144. 0xf068, 0xf069, 0xf06a, 0xf06b, 0xf06c, 0xf06d, 0xf06e, 0xf06f,
  145. 0xf070, 0xf071, 0xf072, 0xf073, 0xf074, 0xf075, 0xf076, 0xf077,
  146. 0xf078, 0xf079, 0xf07a, 0xf07b, 0xf07c, 0xf07d, 0xf07e, 0xf07f,
  147. 0xf080, 0xf081, 0xf082, 0xf083, 0xf084, 0xf085, 0xf086, 0xf087,
  148. 0xf088, 0xf089, 0xf08a, 0xf08b, 0xf08c, 0xf08d, 0xf08e, 0xf08f,
  149. 0xf090, 0xf091, 0xf092, 0xf093, 0xf094, 0xf095, 0xf096, 0xf097,
  150. 0xf098, 0xf099, 0xf09a, 0xf09b, 0xf09c, 0xf09d, 0xf09e, 0xf09f,
  151. 0xf0a0, 0xf0a1, 0xf0a2, 0xf0a3, 0xf0a4, 0xf0a5, 0xf0a6, 0xf0a7,
  152. 0xf0a8, 0xf0a9, 0xf0aa, 0xf0ab, 0xf0ac, 0xf0ad, 0xf0ae, 0xf0af,
  153. 0xf0b0, 0xf0b1, 0xf0b2, 0xf0b3, 0xf0b4, 0xf0b5, 0xf0b6, 0xf0b7,
  154. 0xf0b8, 0xf0b9, 0xf0ba, 0xf0bb, 0xf0bc, 0xf0bd, 0xf0be, 0xf0bf,
  155. 0xf0c0, 0xf0c1, 0xf0c2, 0xf0c3, 0xf0c4, 0xf0c5, 0xf0c6, 0xf0c7,
  156. 0xf0c8, 0xf0c9, 0xf0ca, 0xf0cb, 0xf0cc, 0xf0cd, 0xf0ce, 0xf0cf,
  157. 0xf0d0, 0xf0d1, 0xf0d2, 0xf0d3, 0xf0d4, 0xf0d5, 0xf0d6, 0xf0d7,
  158. 0xf0d8, 0xf0d9, 0xf0da, 0xf0db, 0xf0dc, 0xf0dd, 0xf0de, 0xf0df,
  159. 0xf0e0, 0xf0e1, 0xf0e2, 0xf0e3, 0xf0e4, 0xf0e5, 0xf0e6, 0xf0e7,
  160. 0xf0e8, 0xf0e9, 0xf0ea, 0xf0eb, 0xf0ec, 0xf0ed, 0xf0ee, 0xf0ef,
  161. 0xf0f0, 0xf0f1, 0xf0f2, 0xf0f3, 0xf0f4, 0xf0f5, 0xf0f6, 0xf0f7,
  162. 0xf0f8, 0xf0f9, 0xf0fa, 0xf0fb, 0xf0fc, 0xf0fd, 0xf0fe, 0xf0ff
  163. }
  164. };
  165. /* The standard kernel character-to-font mappings are not invertible
  166. -- this is just a best effort. */
  167. #define MAX_GLYPH 512 /* Max possible glyph value */
  168. static int inv_translate[MAX_NR_CONSOLES];
  169. struct uni_pagedir {
  170. u16 **uni_pgdir[32];
  171. unsigned long refcount;
  172. unsigned long sum;
  173. unsigned char *inverse_translations[4];
  174. int readonly;
  175. };
  176. static struct uni_pagedir *dflt;
  177. static void set_inverse_transl(struct vc_data *conp, struct uni_pagedir *p, int i)
  178. {
  179. int j, glyph;
  180. unsigned short *t = translations[i];
  181. unsigned char *q;
  182. if (!p) return;
  183. q = p->inverse_translations[i];
  184. if (!q) {
  185. q = p->inverse_translations[i] = (unsigned char *)
  186. kmalloc(MAX_GLYPH, GFP_KERNEL);
  187. if (!q) return;
  188. }
  189. memset(q, 0, MAX_GLYPH);
  190. for (j = 0; j < E_TABSZ; j++) {
  191. glyph = conv_uni_to_pc(conp, t[j]);
  192. if (glyph >= 0 && glyph < MAX_GLYPH && q[glyph] < 32) {
  193. /* prefer '-' above SHY etc. */
  194. q[glyph] = j;
  195. }
  196. }
  197. }
  198. unsigned short *set_translate(int m, struct vc_data *vc)
  199. {
  200. inv_translate[vc->vc_num] = m;
  201. return translations[m];
  202. }
  203. /*
  204. * Inverse translation is impossible for several reasons:
  205. * 1. The font<->character maps are not 1-1.
  206. * 2. The text may have been written while a different translation map
  207. * was active, or using Unicode.
  208. * Still, it is now possible to a certain extent to cut and paste non-ASCII.
  209. */
  210. unsigned char inverse_translate(struct vc_data *conp, int glyph)
  211. {
  212. struct uni_pagedir *p;
  213. if (glyph < 0 || glyph >= MAX_GLYPH)
  214. return 0;
  215. else if (!(p = (struct uni_pagedir *)*conp->vc_uni_pagedir_loc) ||
  216. !p->inverse_translations[inv_translate[conp->vc_num]])
  217. return glyph;
  218. else
  219. return p->inverse_translations[inv_translate[conp->vc_num]][glyph];
  220. }
  221. static void update_user_maps(void)
  222. {
  223. int i;
  224. struct uni_pagedir *p, *q = NULL;
  225. for (i = 0; i < MAX_NR_CONSOLES; i++) {
  226. if (!vc_cons_allocated(i))
  227. continue;
  228. p = (struct uni_pagedir *)*vc_cons[i].d->vc_uni_pagedir_loc;
  229. if (p && p != q) {
  230. set_inverse_transl(vc_cons[i].d, p, USER_MAP);
  231. q = p;
  232. }
  233. }
  234. }
  235. /*
  236. * Load customizable translation table
  237. * arg points to a 256 byte translation table.
  238. *
  239. * The "old" variants are for translation directly to font (using the
  240. * 0xf000-0xf0ff "transparent" Unicodes) whereas the "new" variants set
  241. * Unicodes explicitly.
  242. */
  243. int con_set_trans_old(unsigned char __user * arg)
  244. {
  245. int i;
  246. unsigned short *p = translations[USER_MAP];
  247. if (!access_ok(VERIFY_READ, arg, E_TABSZ))
  248. return -EFAULT;
  249. for (i=0; i<E_TABSZ ; i++) {
  250. unsigned char uc;
  251. __get_user(uc, arg+i);
  252. p[i] = UNI_DIRECT_BASE | uc;
  253. }
  254. update_user_maps();
  255. return 0;
  256. }
  257. int con_get_trans_old(unsigned char __user * arg)
  258. {
  259. int i, ch;
  260. unsigned short *p = translations[USER_MAP];
  261. if (!access_ok(VERIFY_WRITE, arg, E_TABSZ))
  262. return -EFAULT;
  263. for (i=0; i<E_TABSZ ; i++)
  264. {
  265. ch = conv_uni_to_pc(vc_cons[fg_console].d, p[i]);
  266. __put_user((ch & ~0xff) ? 0 : ch, arg+i);
  267. }
  268. return 0;
  269. }
  270. int con_set_trans_new(ushort __user * arg)
  271. {
  272. int i;
  273. unsigned short *p = translations[USER_MAP];
  274. if (!access_ok(VERIFY_READ, arg, E_TABSZ*sizeof(unsigned short)))
  275. return -EFAULT;
  276. for (i=0; i<E_TABSZ ; i++) {
  277. unsigned short us;
  278. __get_user(us, arg+i);
  279. p[i] = us;
  280. }
  281. update_user_maps();
  282. return 0;
  283. }
  284. int con_get_trans_new(ushort __user * arg)
  285. {
  286. int i;
  287. unsigned short *p = translations[USER_MAP];
  288. if (!access_ok(VERIFY_WRITE, arg, E_TABSZ*sizeof(unsigned short)))
  289. return -EFAULT;
  290. for (i=0; i<E_TABSZ ; i++)
  291. __put_user(p[i], arg+i);
  292. return 0;
  293. }
  294. /*
  295. * Unicode -> current font conversion
  296. *
  297. * A font has at most 512 chars, usually 256.
  298. * But one font position may represent several Unicode chars.
  299. * A hashtable is somewhat of a pain to deal with, so use a
  300. * "paged table" instead. Simulation has shown the memory cost of
  301. * this 3-level paged table scheme to be comparable to a hash table.
  302. */
  303. extern u8 dfont_unicount[]; /* Defined in console_defmap.c */
  304. extern u16 dfont_unitable[];
  305. static void con_release_unimap(struct uni_pagedir *p)
  306. {
  307. u16 **p1;
  308. int i, j;
  309. if (p == dflt) dflt = NULL;
  310. for (i = 0; i < 32; i++) {
  311. if ((p1 = p->uni_pgdir[i]) != NULL) {
  312. for (j = 0; j < 32; j++)
  313. kfree(p1[j]);
  314. kfree(p1);
  315. }
  316. p->uni_pgdir[i] = NULL;
  317. }
  318. for (i = 0; i < 4; i++) {
  319. kfree(p->inverse_translations[i]);
  320. p->inverse_translations[i] = NULL;
  321. }
  322. }
  323. void con_free_unimap(struct vc_data *vc)
  324. {
  325. struct uni_pagedir *p;
  326. p = (struct uni_pagedir *)*vc->vc_uni_pagedir_loc;
  327. if (!p)
  328. return;
  329. *vc->vc_uni_pagedir_loc = 0;
  330. if (--p->refcount)
  331. return;
  332. con_release_unimap(p);
  333. kfree(p);
  334. }
  335. static int con_unify_unimap(struct vc_data *conp, struct uni_pagedir *p)
  336. {
  337. int i, j, k;
  338. struct uni_pagedir *q;
  339. for (i = 0; i < MAX_NR_CONSOLES; i++) {
  340. if (!vc_cons_allocated(i))
  341. continue;
  342. q = (struct uni_pagedir *)*vc_cons[i].d->vc_uni_pagedir_loc;
  343. if (!q || q == p || q->sum != p->sum)
  344. continue;
  345. for (j = 0; j < 32; j++) {
  346. u16 **p1, **q1;
  347. p1 = p->uni_pgdir[j]; q1 = q->uni_pgdir[j];
  348. if (!p1 && !q1)
  349. continue;
  350. if (!p1 || !q1)
  351. break;
  352. for (k = 0; k < 32; k++) {
  353. if (!p1[k] && !q1[k])
  354. continue;
  355. if (!p1[k] || !q1[k])
  356. break;
  357. if (memcmp(p1[k], q1[k], 64*sizeof(u16)))
  358. break;
  359. }
  360. if (k < 32)
  361. break;
  362. }
  363. if (j == 32) {
  364. q->refcount++;
  365. *conp->vc_uni_pagedir_loc = (unsigned long)q;
  366. con_release_unimap(p);
  367. kfree(p);
  368. return 1;
  369. }
  370. }
  371. return 0;
  372. }
  373. static int
  374. con_insert_unipair(struct uni_pagedir *p, u_short unicode, u_short fontpos)
  375. {
  376. int i, n;
  377. u16 **p1, *p2;
  378. if (!(p1 = p->uni_pgdir[n = unicode >> 11])) {
  379. p1 = p->uni_pgdir[n] = kmalloc(32*sizeof(u16 *), GFP_KERNEL);
  380. if (!p1) return -ENOMEM;
  381. for (i = 0; i < 32; i++)
  382. p1[i] = NULL;
  383. }
  384. if (!(p2 = p1[n = (unicode >> 6) & 0x1f])) {
  385. p2 = p1[n] = kmalloc(64*sizeof(u16), GFP_KERNEL);
  386. if (!p2) return -ENOMEM;
  387. memset(p2, 0xff, 64*sizeof(u16)); /* No glyphs for the characters (yet) */
  388. }
  389. p2[unicode & 0x3f] = fontpos;
  390. p->sum += (fontpos << 20) + unicode;
  391. return 0;
  392. }
  393. /* ui is a leftover from using a hashtable, but might be used again */
  394. int con_clear_unimap(struct vc_data *vc, struct unimapinit *ui)
  395. {
  396. struct uni_pagedir *p, *q;
  397. p = (struct uni_pagedir *)*vc->vc_uni_pagedir_loc;
  398. if (p && p->readonly) return -EIO;
  399. if (!p || --p->refcount) {
  400. q = kmalloc(sizeof(*p), GFP_KERNEL);
  401. if (!q) {
  402. if (p) p->refcount++;
  403. return -ENOMEM;
  404. }
  405. memset(q, 0, sizeof(*q));
  406. q->refcount=1;
  407. *vc->vc_uni_pagedir_loc = (unsigned long)q;
  408. } else {
  409. if (p == dflt) dflt = NULL;
  410. p->refcount++;
  411. p->sum = 0;
  412. con_release_unimap(p);
  413. }
  414. return 0;
  415. }
  416. int con_set_unimap(struct vc_data *vc, ushort ct, struct unipair __user *list)
  417. {
  418. int err = 0, err1, i;
  419. struct uni_pagedir *p, *q;
  420. p = (struct uni_pagedir *)*vc->vc_uni_pagedir_loc;
  421. if (p->readonly) return -EIO;
  422. if (!ct) return 0;
  423. if (p->refcount > 1) {
  424. int j, k;
  425. u16 **p1, *p2, l;
  426. err1 = con_clear_unimap(vc, NULL);
  427. if (err1) return err1;
  428. q = (struct uni_pagedir *)*vc->vc_uni_pagedir_loc;
  429. for (i = 0, l = 0; i < 32; i++)
  430. if ((p1 = p->uni_pgdir[i]))
  431. for (j = 0; j < 32; j++)
  432. if ((p2 = p1[j]))
  433. for (k = 0; k < 64; k++, l++)
  434. if (p2[k] != 0xffff) {
  435. err1 = con_insert_unipair(q, l, p2[k]);
  436. if (err1) {
  437. p->refcount++;
  438. *vc->vc_uni_pagedir_loc = (unsigned long)p;
  439. con_release_unimap(q);
  440. kfree(q);
  441. return err1;
  442. }
  443. }
  444. p = q;
  445. } else if (p == dflt)
  446. dflt = NULL;
  447. while (ct--) {
  448. unsigned short unicode, fontpos;
  449. __get_user(unicode, &list->unicode);
  450. __get_user(fontpos, &list->fontpos);
  451. if ((err1 = con_insert_unipair(p, unicode,fontpos)) != 0)
  452. err = err1;
  453. list++;
  454. }
  455. if (con_unify_unimap(vc, p))
  456. return err;
  457. for (i = 0; i <= 3; i++)
  458. set_inverse_transl(vc, p, i); /* Update all inverse translations */
  459. return err;
  460. }
  461. /* Loads the unimap for the hardware font, as defined in uni_hash.tbl.
  462. The representation used was the most compact I could come up
  463. with. This routine is executed at sys_setup time, and when the
  464. PIO_FONTRESET ioctl is called. */
  465. int con_set_default_unimap(struct vc_data *vc)
  466. {
  467. int i, j, err = 0, err1;
  468. u16 *q;
  469. struct uni_pagedir *p;
  470. if (dflt) {
  471. p = (struct uni_pagedir *)*vc->vc_uni_pagedir_loc;
  472. if (p == dflt)
  473. return 0;
  474. dflt->refcount++;
  475. *vc->vc_uni_pagedir_loc = (unsigned long)dflt;
  476. if (p && --p->refcount) {
  477. con_release_unimap(p);
  478. kfree(p);
  479. }
  480. return 0;
  481. }
  482. /* The default font is always 256 characters */
  483. err = con_clear_unimap(vc, NULL);
  484. if (err) return err;
  485. p = (struct uni_pagedir *)*vc->vc_uni_pagedir_loc;
  486. q = dfont_unitable;
  487. for (i = 0; i < 256; i++)
  488. for (j = dfont_unicount[i]; j; j--) {
  489. err1 = con_insert_unipair(p, *(q++), i);
  490. if (err1)
  491. err = err1;
  492. }
  493. if (con_unify_unimap(vc, p)) {
  494. dflt = (struct uni_pagedir *)*vc->vc_uni_pagedir_loc;
  495. return err;
  496. }
  497. for (i = 0; i <= 3; i++)
  498. set_inverse_transl(vc, p, i); /* Update all inverse translations */
  499. dflt = p;
  500. return err;
  501. }
  502. EXPORT_SYMBOL(con_set_default_unimap);
  503. int con_copy_unimap(struct vc_data *dst_vc, struct vc_data *src_vc)
  504. {
  505. struct uni_pagedir *q;
  506. if (!*src_vc->vc_uni_pagedir_loc)
  507. return -EINVAL;
  508. if (*dst_vc->vc_uni_pagedir_loc == *src_vc->vc_uni_pagedir_loc)
  509. return 0;
  510. con_free_unimap(dst_vc);
  511. q = (struct uni_pagedir *)*src_vc->vc_uni_pagedir_loc;
  512. q->refcount++;
  513. *dst_vc->vc_uni_pagedir_loc = (long)q;
  514. return 0;
  515. }
  516. int con_get_unimap(struct vc_data *vc, ushort ct, ushort __user *uct, struct unipair __user *list)
  517. {
  518. int i, j, k, ect;
  519. u16 **p1, *p2;
  520. struct uni_pagedir *p;
  521. ect = 0;
  522. if (*vc->vc_uni_pagedir_loc) {
  523. p = (struct uni_pagedir *)*vc->vc_uni_pagedir_loc;
  524. for (i = 0; i < 32; i++)
  525. if ((p1 = p->uni_pgdir[i]))
  526. for (j = 0; j < 32; j++)
  527. if ((p2 = *(p1++)))
  528. for (k = 0; k < 64; k++) {
  529. if (*p2 < MAX_GLYPH && ect++ < ct) {
  530. __put_user((u_short)((i<<11)+(j<<6)+k),
  531. &list->unicode);
  532. __put_user((u_short) *p2,
  533. &list->fontpos);
  534. list++;
  535. }
  536. p2++;
  537. }
  538. }
  539. __put_user(ect, uct);
  540. return ((ect <= ct) ? 0 : -ENOMEM);
  541. }
  542. void con_protect_unimap(struct vc_data *vc, int rdonly)
  543. {
  544. struct uni_pagedir *p = (struct uni_pagedir *)*vc->vc_uni_pagedir_loc;
  545. if (p)
  546. p->readonly = rdonly;
  547. }
  548. int
  549. conv_uni_to_pc(struct vc_data *conp, long ucs)
  550. {
  551. int h;
  552. u16 **p1, *p2;
  553. struct uni_pagedir *p;
  554. /* Only 16-bit codes supported at this time */
  555. if (ucs > 0xffff)
  556. ucs = 0xfffd; /* U+FFFD: REPLACEMENT CHARACTER */
  557. else if (ucs < 0x20 || ucs >= 0xfffe)
  558. return -1; /* Not a printable character */
  559. else if (ucs == 0xfeff || (ucs >= 0x200a && ucs <= 0x200f))
  560. return -2; /* Zero-width space */
  561. /*
  562. * UNI_DIRECT_BASE indicates the start of the region in the User Zone
  563. * which always has a 1:1 mapping to the currently loaded font. The
  564. * UNI_DIRECT_MASK indicates the bit span of the region.
  565. */
  566. else if ((ucs & ~UNI_DIRECT_MASK) == UNI_DIRECT_BASE)
  567. return ucs & UNI_DIRECT_MASK;
  568. if (!*conp->vc_uni_pagedir_loc)
  569. return -3;
  570. p = (struct uni_pagedir *)*conp->vc_uni_pagedir_loc;
  571. if ((p1 = p->uni_pgdir[ucs >> 11]) &&
  572. (p2 = p1[(ucs >> 6) & 0x1f]) &&
  573. (h = p2[ucs & 0x3f]) < MAX_GLYPH)
  574. return h;
  575. return -4; /* not found */
  576. }
  577. /*
  578. * This is called at sys_setup time, after memory and the console are
  579. * initialized. It must be possible to call kmalloc(..., GFP_KERNEL)
  580. * from this function, hence the call from sys_setup.
  581. */
  582. void __init
  583. console_map_init(void)
  584. {
  585. int i;
  586. for (i = 0; i < MAX_NR_CONSOLES; i++)
  587. if (vc_cons_allocated(i) && !*vc_cons[i].d->vc_uni_pagedir_loc)
  588. con_set_default_unimap(vc_cons[i].d);
  589. }
  590. EXPORT_SYMBOL(con_copy_unimap);