drivers/char/consolemap.c

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