1 | /* vi: set sw=4 ts=4: */
|
---|
2 | /*
|
---|
3 | * loadfont.c - Eugene Crosser & Andries Brouwer
|
---|
4 | *
|
---|
5 | * Version 0.96bb
|
---|
6 | *
|
---|
7 | * Loads the console font, and possibly the corresponding screen map(s).
|
---|
8 | * (Adapted for busybox by Matej Vela.)
|
---|
9 | */
|
---|
10 | #include <stdio.h>
|
---|
11 | #include <string.h>
|
---|
12 | #include <fcntl.h>
|
---|
13 | #include <stdlib.h>
|
---|
14 | #include <unistd.h>
|
---|
15 | #include <sys/types.h>
|
---|
16 | #include <dirent.h>
|
---|
17 | #include <errno.h>
|
---|
18 | #include <sys/ioctl.h>
|
---|
19 | #include <sys/kd.h>
|
---|
20 | #include <endian.h>
|
---|
21 | #include "busybox.h"
|
---|
22 |
|
---|
23 | enum{
|
---|
24 | PSF_MAGIC1 = 0x36,
|
---|
25 | PSF_MAGIC2 = 0x04,
|
---|
26 |
|
---|
27 | PSF_MODE512 = 0x01,
|
---|
28 | PSF_MODEHASTAB = 0x02,
|
---|
29 | PSF_MAXMODE = 0x03,
|
---|
30 | PSF_SEPARATOR = 0xFFFF
|
---|
31 | };
|
---|
32 |
|
---|
33 | struct psf_header {
|
---|
34 | unsigned char magic1, magic2; /* Magic number */
|
---|
35 | unsigned char mode; /* PSF font mode */
|
---|
36 | unsigned char charsize; /* Character size */
|
---|
37 | };
|
---|
38 |
|
---|
39 | #define PSF_MAGIC_OK(x) ((x).magic1 == PSF_MAGIC1 && (x).magic2 == PSF_MAGIC2)
|
---|
40 |
|
---|
41 | static void loadnewfont(int fd);
|
---|
42 |
|
---|
43 | int loadfont_main(int argc, char **argv)
|
---|
44 | {
|
---|
45 | int fd;
|
---|
46 |
|
---|
47 | if (argc != 1)
|
---|
48 | bb_show_usage();
|
---|
49 |
|
---|
50 | fd = bb_xopen(CURRENT_VC, O_RDWR);
|
---|
51 | loadnewfont(fd);
|
---|
52 |
|
---|
53 | return EXIT_SUCCESS;
|
---|
54 | }
|
---|
55 |
|
---|
56 | static void do_loadfont(int fd, unsigned char *inbuf, int unit, int fontsize)
|
---|
57 | {
|
---|
58 | char buf[16384];
|
---|
59 | int i;
|
---|
60 |
|
---|
61 | memset(buf, 0, sizeof(buf));
|
---|
62 |
|
---|
63 | if (unit < 1 || unit > 32)
|
---|
64 | bb_error_msg_and_die("Bad character size %d", unit);
|
---|
65 |
|
---|
66 | for (i = 0; i < fontsize; i++)
|
---|
67 | memcpy(buf + (32 * i), inbuf + (unit * i), unit);
|
---|
68 |
|
---|
69 | #if defined( PIO_FONTX ) && !defined( __sparc__ )
|
---|
70 | {
|
---|
71 | struct consolefontdesc cfd;
|
---|
72 |
|
---|
73 | cfd.charcount = fontsize;
|
---|
74 | cfd.charheight = unit;
|
---|
75 | cfd.chardata = buf;
|
---|
76 |
|
---|
77 | if (ioctl(fd, PIO_FONTX, &cfd) == 0)
|
---|
78 | return; /* success */
|
---|
79 | bb_perror_msg("PIO_FONTX ioctl error (trying PIO_FONT)");
|
---|
80 | }
|
---|
81 | #endif
|
---|
82 | if (ioctl(fd, PIO_FONT, buf))
|
---|
83 | bb_perror_msg_and_die("PIO_FONT ioctl error");
|
---|
84 | }
|
---|
85 |
|
---|
86 | static void
|
---|
87 | do_loadtable(int fd, unsigned char *inbuf, int tailsz, int fontsize)
|
---|
88 | {
|
---|
89 | struct unimapinit advice;
|
---|
90 | struct unimapdesc ud;
|
---|
91 | struct unipair *up;
|
---|
92 | int ct = 0, maxct;
|
---|
93 | int glyph;
|
---|
94 | u_short unicode;
|
---|
95 |
|
---|
96 | maxct = tailsz; /* more than enough */
|
---|
97 | up = (struct unipair *) xmalloc(maxct * sizeof(struct unipair));
|
---|
98 |
|
---|
99 | for (glyph = 0; glyph < fontsize; glyph++) {
|
---|
100 | while (tailsz >= 2) {
|
---|
101 | unicode = (((u_short) inbuf[1]) << 8) + inbuf[0];
|
---|
102 | tailsz -= 2;
|
---|
103 | inbuf += 2;
|
---|
104 | if (unicode == PSF_SEPARATOR)
|
---|
105 | break;
|
---|
106 | up[ct].unicode = unicode;
|
---|
107 | up[ct].fontpos = glyph;
|
---|
108 | ct++;
|
---|
109 | }
|
---|
110 | }
|
---|
111 |
|
---|
112 | /* Note: after PIO_UNIMAPCLR and before PIO_UNIMAP
|
---|
113 | this printf did not work on many kernels */
|
---|
114 |
|
---|
115 | advice.advised_hashsize = 0;
|
---|
116 | advice.advised_hashstep = 0;
|
---|
117 | advice.advised_hashlevel = 0;
|
---|
118 | if (ioctl(fd, PIO_UNIMAPCLR, &advice)) {
|
---|
119 | #ifdef ENOIOCTLCMD
|
---|
120 | if (errno == ENOIOCTLCMD) {
|
---|
121 | bb_error_msg("It seems this kernel is older than 1.1.92");
|
---|
122 | bb_error_msg_and_die("No Unicode mapping table loaded.");
|
---|
123 | } else
|
---|
124 | #endif
|
---|
125 | bb_perror_msg_and_die("PIO_UNIMAPCLR");
|
---|
126 | }
|
---|
127 | ud.entry_ct = ct;
|
---|
128 | ud.entries = up;
|
---|
129 | if (ioctl(fd, PIO_UNIMAP, &ud)) {
|
---|
130 | #if 0
|
---|
131 | if (errno == ENOMEM) {
|
---|
132 | /* change advice parameters */
|
---|
133 | }
|
---|
134 | #endif
|
---|
135 | bb_perror_msg_and_die("PIO_UNIMAP");
|
---|
136 | }
|
---|
137 | }
|
---|
138 |
|
---|
139 | static void loadnewfont(int fd)
|
---|
140 | {
|
---|
141 | int unit;
|
---|
142 | unsigned char inbuf[32768]; /* primitive */
|
---|
143 | unsigned int inputlth, offset;
|
---|
144 |
|
---|
145 | /*
|
---|
146 | * We used to look at the length of the input file
|
---|
147 | * with stat(); now that we accept compressed files,
|
---|
148 | * just read the entire file.
|
---|
149 | */
|
---|
150 | inputlth = fread(inbuf, 1, sizeof(inbuf), stdin);
|
---|
151 | if (ferror(stdin))
|
---|
152 | bb_perror_msg_and_die("Error reading input font");
|
---|
153 | /* use malloc/realloc in case of giant files;
|
---|
154 | maybe these do not occur: 16kB for the font,
|
---|
155 | and 16kB for the map leaves 32 unicode values
|
---|
156 | for each font position */
|
---|
157 | if (!feof(stdin))
|
---|
158 | bb_perror_msg_and_die("Font too large");
|
---|
159 |
|
---|
160 | /* test for psf first */
|
---|
161 | {
|
---|
162 | struct psf_header psfhdr;
|
---|
163 | int fontsize;
|
---|
164 | int hastable;
|
---|
165 | unsigned int head0, head;
|
---|
166 |
|
---|
167 | if (inputlth < sizeof(struct psf_header))
|
---|
168 | goto no_psf;
|
---|
169 |
|
---|
170 | psfhdr = *(struct psf_header *) &inbuf[0];
|
---|
171 |
|
---|
172 | if (!PSF_MAGIC_OK(psfhdr))
|
---|
173 | goto no_psf;
|
---|
174 |
|
---|
175 | if (psfhdr.mode > PSF_MAXMODE)
|
---|
176 | bb_error_msg_and_die("Unsupported psf file mode");
|
---|
177 | fontsize = ((psfhdr.mode & PSF_MODE512) ? 512 : 256);
|
---|
178 | #if !defined( PIO_FONTX ) || defined( __sparc__ )
|
---|
179 | if (fontsize != 256)
|
---|
180 | bb_error_msg_and_die("Only fontsize 256 supported");
|
---|
181 | #endif
|
---|
182 | hastable = (psfhdr.mode & PSF_MODEHASTAB);
|
---|
183 | unit = psfhdr.charsize;
|
---|
184 | head0 = sizeof(struct psf_header);
|
---|
185 |
|
---|
186 | head = head0 + fontsize * unit;
|
---|
187 | if (head > inputlth || (!hastable && head != inputlth))
|
---|
188 | bb_error_msg_and_die("Input file: bad length");
|
---|
189 | do_loadfont(fd, inbuf + head0, unit, fontsize);
|
---|
190 | if (hastable)
|
---|
191 | do_loadtable(fd, inbuf + head, inputlth - head, fontsize);
|
---|
192 | return;
|
---|
193 | }
|
---|
194 | no_psf:
|
---|
195 |
|
---|
196 | /* file with three code pages? */
|
---|
197 | if (inputlth == 9780) {
|
---|
198 | offset = 40;
|
---|
199 | unit = 16;
|
---|
200 | } else {
|
---|
201 | /* bare font */
|
---|
202 | if (inputlth & 0377)
|
---|
203 | bb_error_msg_and_die("Bad input file size");
|
---|
204 | offset = 0;
|
---|
205 | unit = inputlth / 256;
|
---|
206 | }
|
---|
207 | do_loadfont(fd, inbuf + offset, unit, 256);
|
---|
208 | }
|
---|