?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Initial commit
[wrt350n-kernel.git] / drivers / char / consolemap.c
blob6b104e45a322b3a5bd321a07f12a4c3936441db6
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 u16 *inverse_trans_unicode;
181 int readonly;
182 };
183
184 static struct uni_pagedir *dflt;
185
186 static void set_inverse_transl(struct vc_data *conp, struct uni_pagedir *p, int i)
187 {
188 int j, glyph;
189 unsigned short *t = translations[i];
190 unsigned char *q;
191
192 if (!p) return;
193 q = p->inverse_translations[i];
194
195 if (!q) {
196 q = p->inverse_translations[i] = (unsigned char *)
197 kmalloc(MAX_GLYPH, GFP_KERNEL);
198 if (!q) return;
199 }
200 memset(q, 0, MAX_GLYPH);
201
202 for (j = 0; j < E_TABSZ; j++) {
203 glyph = conv_uni_to_pc(conp, t[j]);
204 if (glyph >= 0 && glyph < MAX_GLYPH && q[glyph] < 32) {
205 /* prefer '-' above SHY etc. */
206 q[glyph] = j;
207 }
208 }
209 }
210
211 static void set_inverse_trans_unicode(struct vc_data *conp,
212 struct uni_pagedir *p)
213 {
214 int i, j, k, glyph;
215 u16 **p1, *p2;
216 u16 *q;
217
218 if (!p) return;
219 q = p->inverse_trans_unicode;
220 if (!q) {
221 q = p->inverse_trans_unicode =
222 kmalloc(MAX_GLYPH * sizeof(u16), GFP_KERNEL);
223 if (!q)
224 return;
225 }
226 memset(q, 0, MAX_GLYPH * sizeof(u16));
227
228 for (i = 0; i < 32; i++) {
229 p1 = p->uni_pgdir[i];
230 if (!p1)
231 continue;
232 for (j = 0; j < 32; j++) {
233 p2 = p1[j];
234 if (!p2)
235 continue;
236 for (k = 0; k < 64; k++) {
237 glyph = p2[k];
238 if (glyph >= 0 && glyph < MAX_GLYPH
239 && q[glyph] < 32)
240 q[glyph] = (i << 11) + (j << 6) + k;
241 }
242 }
243 }
244 }
245
246 unsigned short *set_translate(int m, struct vc_data *vc)
247 {
248 inv_translate[vc->vc_num] = m;
249 return translations[m];
250 }
251
252 /*
253 * Inverse translation is impossible for several reasons:
254 * 1. The font<->character maps are not 1-1.
255 * 2. The text may have been written while a different translation map
256 * was active.
257 * Still, it is now possible to a certain extent to cut and paste non-ASCII.
258 */
259 u16 inverse_translate(struct vc_data *conp, int glyph, int use_unicode)
260 {
261 struct uni_pagedir *p;
262 int m;
263 if (glyph < 0 || glyph >= MAX_GLYPH)
264 return 0;
265 else if (!(p = (struct uni_pagedir *)*conp->vc_uni_pagedir_loc))
266 return glyph;
267 else if (use_unicode) {
268 if (!p->inverse_trans_unicode)
269 return glyph;
270 else
271 return p->inverse_trans_unicode[glyph];
272 } else {
273 m = inv_translate[conp->vc_num];
274 if (!p->inverse_translations[m])
275 return glyph;
276 else
277 return p->inverse_translations[m][glyph];
278 }
279 }
280
281 static void update_user_maps(void)
282 {
283 int i;
284 struct uni_pagedir *p, *q = NULL;
285
286 for (i = 0; i < MAX_NR_CONSOLES; i++) {
287 if (!vc_cons_allocated(i))
288 continue;
289 p = (struct uni_pagedir *)*vc_cons[i].d->vc_uni_pagedir_loc;
290 if (p && p != q) {
291 set_inverse_transl(vc_cons[i].d, p, USER_MAP);
292 set_inverse_trans_unicode(vc_cons[i].d, p);
293 q = p;
294 }
295 }
296 }
297
298 /*
299 * Load customizable translation table
300 * arg points to a 256 byte translation table.
301 *
302 * The "old" variants are for translation directly to font (using the
303 * 0xf000-0xf0ff "transparent" Unicodes) whereas the "new" variants set
304 * Unicodes explicitly.
305 */
306 int con_set_trans_old(unsigned char __user * arg)
307 {
308 int i;
309 unsigned short *p = translations[USER_MAP];
310
311 if (!access_ok(VERIFY_READ, arg, E_TABSZ))
312 return -EFAULT;
313
314 for (i=0; i<E_TABSZ ; i++) {
315 unsigned char uc;
316 __get_user(uc, arg+i);
317 p[i] = UNI_DIRECT_BASE | uc;
318 }
319
320 update_user_maps();
321 return 0;
322 }
323
324 int con_get_trans_old(unsigned char __user * arg)
325 {
326 int i, ch;
327 unsigned short *p = translations[USER_MAP];
328
329 if (!access_ok(VERIFY_WRITE, arg, E_TABSZ))
330 return -EFAULT;
331
332 for (i=0; i<E_TABSZ ; i++)
333 {
334 ch = conv_uni_to_pc(vc_cons[fg_console].d, p[i]);
335 __put_user((ch & ~0xff) ? 0 : ch, arg+i);
336 }
337 return 0;
338 }
339
340 int con_set_trans_new(ushort __user * arg)
341 {
342 int i;
343 unsigned short *p = translations[USER_MAP];
344
345 if (!access_ok(VERIFY_READ, arg, E_TABSZ*sizeof(unsigned short)))
346 return -EFAULT;
347
348 for (i=0; i<E_TABSZ ; i++) {
349 unsigned short us;
350 __get_user(us, arg+i);
351 p[i] = us;
352 }
353
354 update_user_maps();
355 return 0;
356 }
357
358 int con_get_trans_new(ushort __user * arg)
359 {
360 int i;
361 unsigned short *p = translations[USER_MAP];
362
363 if (!access_ok(VERIFY_WRITE, arg, E_TABSZ*sizeof(unsigned short)))
364 return -EFAULT;
365
366 for (i=0; i<E_TABSZ ; i++)
367 __put_user(p[i], arg+i);
368
369 return 0;
370 }
371
372 /*
373 * Unicode -> current font conversion
374 *
375 * A font has at most 512 chars, usually 256.
376 * But one font position may represent several Unicode chars.
377 * A hashtable is somewhat of a pain to deal with, so use a
378 * "paged table" instead. Simulation has shown the memory cost of
379 * this 3-level paged table scheme to be comparable to a hash table.
380 */
381
382 extern u8 dfont_unicount[]; /* Defined in console_defmap.c */
383 extern u16 dfont_unitable[];
384
385 static void con_release_unimap(struct uni_pagedir *p)
386 {
387 u16 **p1;
388 int i, j;
389
390 if (p == dflt) dflt = NULL;
391 for (i = 0; i < 32; i++) {
392 if ((p1 = p->uni_pgdir[i]) != NULL) {
393 for (j = 0; j < 32; j++)
394 kfree(p1[j]);
395 kfree(p1);
396 }
397 p->uni_pgdir[i] = NULL;
398 }
399 for (i = 0; i < 4; i++) {
400 kfree(p->inverse_translations[i]);
401 p->inverse_translations[i] = NULL;
402 }
403 if (p->inverse_trans_unicode) {
404 kfree(p->inverse_trans_unicode);
405 p->inverse_trans_unicode = NULL;
406 }
407 }
408
409 void con_free_unimap(struct vc_data *vc)
410 {
411 struct uni_pagedir *p;
412
413 p = (struct uni_pagedir *)*vc->vc_uni_pagedir_loc;
414 if (!p)
415 return;
416 *vc->vc_uni_pagedir_loc = 0;
417 if (--p->refcount)
418 return;
419 con_release_unimap(p);
420 kfree(p);
421 }
422
423 static int con_unify_unimap(struct vc_data *conp, struct uni_pagedir *p)
424 {
425 int i, j, k;
426 struct uni_pagedir *q;
427
428 for (i = 0; i < MAX_NR_CONSOLES; i++) {
429 if (!vc_cons_allocated(i))
430 continue;
431 q = (struct uni_pagedir *)*vc_cons[i].d->vc_uni_pagedir_loc;
432 if (!q || q == p || q->sum != p->sum)
433 continue;
434 for (j = 0; j < 32; j++) {
435 u16 **p1, **q1;
436 p1 = p->uni_pgdir[j]; q1 = q->uni_pgdir[j];
437 if (!p1 && !q1)
438 continue;
439 if (!p1 || !q1)
440 break;
441 for (k = 0; k < 32; k++) {
442 if (!p1[k] && !q1[k])
443 continue;
444 if (!p1[k] || !q1[k])
445 break;
446 if (memcmp(p1[k], q1[k], 64*sizeof(u16)))
447 break;
448 }
449 if (k < 32)
450 break;
451 }
452 if (j == 32) {
453 q->refcount++;
454 *conp->vc_uni_pagedir_loc = (unsigned long)q;
455 con_release_unimap(p);
456 kfree(p);
457 return 1;
458 }
459 }
460 return 0;
461 }
462
463 static int
464 con_insert_unipair(struct uni_pagedir *p, u_short unicode, u_short fontpos)
465 {
466 int i, n;
467 u16 **p1, *p2;
468
469 if (!(p1 = p->uni_pgdir[n = unicode >> 11])) {
470 p1 = p->uni_pgdir[n] = kmalloc(32*sizeof(u16 *), GFP_KERNEL);
471 if (!p1) return -ENOMEM;
472 for (i = 0; i < 32; i++)
473 p1[i] = NULL;
474 }
475
476 if (!(p2 = p1[n = (unicode >> 6) & 0x1f])) {
477 p2 = p1[n] = kmalloc(64*sizeof(u16), GFP_KERNEL);
478 if (!p2) return -ENOMEM;
479 memset(p2, 0xff, 64*sizeof(u16)); /* No glyphs for the characters (yet) */
480 }
481
482 p2[unicode & 0x3f] = fontpos;
483
484 p->sum += (fontpos << 20) + unicode;
485
486 return 0;
487 }
488
489 /* ui is a leftover from using a hashtable, but might be used again */
490 int con_clear_unimap(struct vc_data *vc, struct unimapinit *ui)
491 {
492 struct uni_pagedir *p, *q;
493
494 p = (struct uni_pagedir *)*vc->vc_uni_pagedir_loc;
495 if (p && p->readonly) return -EIO;
496 if (!p || --p->refcount) {
497 q = kzalloc(sizeof(*p), GFP_KERNEL);
498 if (!q) {
499 if (p) p->refcount++;
500 return -ENOMEM;
501 }
502 q->refcount=1;
503 *vc->vc_uni_pagedir_loc = (unsigned long)q;
504 } else {
505 if (p == dflt) dflt = NULL;
506 p->refcount++;
507 p->sum = 0;
508 con_release_unimap(p);
509 }
510 return 0;
511 }
512
513 int con_set_unimap(struct vc_data *vc, ushort ct, struct unipair __user *list)
514 {
515 int err = 0, err1, i;
516 struct uni_pagedir *p, *q;
517
518 p = (struct uni_pagedir *)*vc->vc_uni_pagedir_loc;
519 if (p->readonly) return -EIO;
520
521 if (!ct) return 0;
522
523 if (p->refcount > 1) {
524 int j, k;
525 u16 **p1, *p2, l;
526
527 err1 = con_clear_unimap(vc, NULL);
528 if (err1) return err1;
529
530 q = (struct uni_pagedir *)*vc->vc_uni_pagedir_loc;
531 for (i = 0, l = 0; i < 32; i++)
532 if ((p1 = p->uni_pgdir[i]))
533 for (j = 0; j < 32; j++)
534 if ((p2 = p1[j]))
535 for (k = 0; k < 64; k++, l++)
536 if (p2[k] != 0xffff) {
537 err1 = con_insert_unipair(q, l, p2[k]);
538 if (err1) {
539 p->refcount++;
540 *vc->vc_uni_pagedir_loc = (unsigned long)p;
541 con_release_unimap(q);
542 kfree(q);
543 return err1;
544 }
545 }
546 p = q;
547 } else if (p == dflt)
548 dflt = NULL;
549
550 while (ct--) {
551 unsigned short unicode, fontpos;
552 __get_user(unicode, &list->unicode);
553 __get_user(fontpos, &list->fontpos);
554 if ((err1 = con_insert_unipair(p, unicode,fontpos)) != 0)
555 err = err1;
556 list++;
557 }
558
559 if (con_unify_unimap(vc, p))
560 return err;
561
562 for (i = 0; i <= 3; i++)
563 set_inverse_transl(vc, p, i); /* Update all inverse translations */
564 set_inverse_trans_unicode(vc, p);
565
566 return err;
567 }
568
569 /* Loads the unimap for the hardware font, as defined in uni_hash.tbl.
570 The representation used was the most compact I could come up
571 with. This routine is executed at sys_setup time, and when the
572 PIO_FONTRESET ioctl is called. */
573
574 int con_set_default_unimap(struct vc_data *vc)
575 {
576 int i, j, err = 0, err1;
577 u16 *q;
578 struct uni_pagedir *p;
579
580 if (dflt) {
581 p = (struct uni_pagedir *)*vc->vc_uni_pagedir_loc;
582 if (p == dflt)
583 return 0;
584 dflt->refcount++;
585 *vc->vc_uni_pagedir_loc = (unsigned long)dflt;
586 if (p && --p->refcount) {
587 con_release_unimap(p);
588 kfree(p);
589 }
590 return 0;
591 }
592
593 /* The default font is always 256 characters */
594
595 err = con_clear_unimap(vc, NULL);
596 if (err) return err;
597
598 p = (struct uni_pagedir *)*vc->vc_uni_pagedir_loc;
599 q = dfont_unitable;
600
601 for (i = 0; i < 256; i++)
602 for (j = dfont_unicount[i]; j; j--) {
603 err1 = con_insert_unipair(p, *(q++), i);
604 if (err1)
605 err = err1;
606 }
607
608 if (con_unify_unimap(vc, p)) {
609 dflt = (struct uni_pagedir *)*vc->vc_uni_pagedir_loc;
610 return err;
611 }
612
613 for (i = 0; i <= 3; i++)
614 set_inverse_transl(vc, p, i); /* Update all inverse translations */
615 set_inverse_trans_unicode(vc, p);
616 dflt = p;
617 return err;
618 }
619 EXPORT_SYMBOL(con_set_default_unimap);
620
621 int con_copy_unimap(struct vc_data *dst_vc, struct vc_data *src_vc)
622 {
623 struct uni_pagedir *q;
624
625 if (!*src_vc->vc_uni_pagedir_loc)
626 return -EINVAL;
627 if (*dst_vc->vc_uni_pagedir_loc == *src_vc->vc_uni_pagedir_loc)
628 return 0;
629 con_free_unimap(dst_vc);
630 q = (struct uni_pagedir *)*src_vc->vc_uni_pagedir_loc;
631 q->refcount++;
632 *dst_vc->vc_uni_pagedir_loc = (long)q;
633 return 0;
634 }
635
636 int con_get_unimap(struct vc_data *vc, ushort ct, ushort __user *uct, struct unipair __user *list)
637 {
638 int i, j, k, ect;
639 u16 **p1, *p2;
640 struct uni_pagedir *p;
641
642 ect = 0;
643 if (*vc->vc_uni_pagedir_loc) {
644 p = (struct uni_pagedir *)*vc->vc_uni_pagedir_loc;
645 for (i = 0; i < 32; i++)
646 if ((p1 = p->uni_pgdir[i]))
647 for (j = 0; j < 32; j++)
648 if ((p2 = *(p1++)))
649 for (k = 0; k < 64; k++) {
650 if (*p2 < MAX_GLYPH && ect++ < ct) {
651 __put_user((u_short)((i<<11)+(j<<6)+k),
652 &list->unicode);
653 __put_user((u_short) *p2,
654 &list->fontpos);
655 list++;
656 }
657 p2++;
658 }
659 }
660 __put_user(ect, uct);
661 return ((ect <= ct) ? 0 : -ENOMEM);
662 }
663
664 void con_protect_unimap(struct vc_data *vc, int rdonly)
665 {
666 struct uni_pagedir *p = (struct uni_pagedir *)*vc->vc_uni_pagedir_loc;
667
668 if (p)
669 p->readonly = rdonly;
670 }
671
672 /*
673 * Always use USER_MAP. These functions are used by the keyboard,
674 * which shouldn't be affected by G0/G1 switching, etc.
675 * If the user map still contains default values, i.e. the
676 * direct-to-font mapping, then assume user is using Latin1.
677 */
678 /* may be called during an interrupt */
679 u32 conv_8bit_to_uni(unsigned char c)
680 {
681 unsigned short uni = translations[USER_MAP][c];
682 return uni == (0xf000 | c) ? c : uni;
683 }
684
685 int conv_uni_to_8bit(u32 uni)
686 {
687 int c;
688 for (c = 0; c < 0x100; c++)
689 if (translations[USER_MAP][c] == uni ||
690 (translations[USER_MAP][c] == (c | 0xf000) && uni == c))
691 return c;
692 return -1;
693 }
694
695 int
696 conv_uni_to_pc(struct vc_data *conp, long ucs)
697 {
698 int h;
699 u16 **p1, *p2;
700 struct uni_pagedir *p;
701
702 /* Only 16-bit codes supported at this time */
703 if (ucs > 0xffff)
704 return -4; /* Not found */
705 else if (ucs < 0x20)
706 return -1; /* Not a printable character */
707 else if (ucs == 0xfeff || (ucs >= 0x200b && ucs <= 0x200f))
708 return -2; /* Zero-width space */
709 /*
710 * UNI_DIRECT_BASE indicates the start of the region in the User Zone
711 * which always has a 1:1 mapping to the currently loaded font. The
712 * UNI_DIRECT_MASK indicates the bit span of the region.
713 */
714 else if ((ucs & ~UNI_DIRECT_MASK) == UNI_DIRECT_BASE)
715 return ucs & UNI_DIRECT_MASK;
716
717 if (!*conp->vc_uni_pagedir_loc)
718 return -3;
719
720 p = (struct uni_pagedir *)*conp->vc_uni_pagedir_loc;
721 if ((p1 = p->uni_pgdir[ucs >> 11]) &&
722 (p2 = p1[(ucs >> 6) & 0x1f]) &&
723 (h = p2[ucs & 0x3f]) < MAX_GLYPH)
724 return h;
725
726 return -4; /* not found */
727 }
728
729 /*
730 * This is called at sys_setup time, after memory and the console are
731 * initialized. It must be possible to call kmalloc(..., GFP_KERNEL)
732 * from this function, hence the call from sys_setup.
733 */
734 void __init
735 console_map_init(void)
736 {
737 int i;
738
739 for (i = 0; i < MAX_NR_CONSOLES; i++)
740 if (vc_cons_allocated(i) && !*vc_cons[i].d->vc_uni_pagedir_loc)
741 con_set_default_unimap(vc_cons[i].d);
742 }
743
744 EXPORT_SYMBOL(con_copy_unimap);
WRT350N Kernel Patches