| /* vi: set sw=4 ts=4: */ |
| /* |
| * loadfont.c - Eugene Crosser & Andries Brouwer |
| * |
| * Version 0.96bb |
| * |
| * Loads the console font, and possibly the corresponding screen map(s). |
| * (Adapted for busybox by Matej Vela.) |
| */ |
| #include "libbb.h" |
| #include <sys/kd.h> |
| |
| #ifndef KDFONTOP |
| #define KDFONTOP 0x4B72 |
| struct console_font_op { |
| unsigned op; /* KD_FONT_OP_* */ |
| unsigned flags; /* KD_FONT_FLAG_* */ |
| unsigned width, height; |
| unsigned charcount; |
| unsigned char *data; /* font data with height fixed to 32 */ |
| }; |
| |
| #define KD_FONT_OP_SET 0 /* Set font */ |
| #define KD_FONT_OP_GET 1 /* Get font */ |
| #define KD_FONT_OP_SET_DEFAULT 2 /* Set font to default, |
| data points to name / NULL */ |
| #define KD_FONT_OP_COPY 3 /* Copy from another console */ |
| |
| #define KD_FONT_FLAG_OLD 0x80000000 /* Invoked via old interface */ |
| #define KD_FONT_FLAG_DONT_RECALC 1 /* Don't call adjust_height() */ |
| /* (Used internally for PIO_FONT support) */ |
| #endif /* KDFONTOP */ |
| |
| |
| enum { |
| PSF_MAGIC1 = 0x36, |
| PSF_MAGIC2 = 0x04, |
| |
| PSF_MODE512 = 0x01, |
| PSF_MODEHASTAB = 0x02, |
| PSF_MAXMODE = 0x03, |
| PSF_SEPARATOR = 0xffff |
| }; |
| |
| struct psf_header { |
| unsigned char magic1, magic2; /* Magic number */ |
| unsigned char mode; /* PSF font mode */ |
| unsigned char charsize; /* Character size */ |
| }; |
| |
| #define PSF_MAGIC_OK(x) ((x)->magic1 == PSF_MAGIC1 && (x)->magic2 == PSF_MAGIC2) |
| |
| static void do_loadfont(int fd, unsigned char *inbuf, int unit, int fontsize) |
| { |
| char *buf; |
| int i; |
| |
| if (unit < 1 || unit > 32) |
| bb_error_msg_and_die("bad character size %d", unit); |
| |
| buf = xzalloc(16 * 1024); |
| for (i = 0; i < fontsize; i++) |
| memcpy(buf + (32 * i), inbuf + (unit * i), unit); |
| |
| { /* KDFONTOP */ |
| struct console_font_op cfo; |
| |
| cfo.op = KD_FONT_OP_SET; |
| cfo.flags = 0; |
| cfo.width = 8; |
| cfo.height = unit; |
| cfo.charcount = fontsize; |
| cfo.data = (void*)buf; |
| #if 0 |
| if (!ioctl_or_perror(fd, KDFONTOP, &cfo, "KDFONTOP ioctl failed (will try PIO_FONTX)")) |
| goto ret; /* success */ |
| #else |
| xioctl(fd, KDFONTOP, &cfo); |
| #endif |
| } |
| |
| #if 0 |
| /* These ones do not honour -C tty (they set font on current tty regardless) */ |
| #if defined(PIO_FONTX) && !defined(__sparc__) |
| { |
| struct consolefontdesc cfd; |
| |
| cfd.charcount = fontsize; |
| cfd.charheight = unit; |
| cfd.chardata = buf; |
| |
| if (!ioctl_or_perror(fd, PIO_FONTX, &cfd, "PIO_FONTX ioctl failed (will try PIO_FONT)")) |
| goto ret; /* success */ |
| } |
| #endif |
| xioctl(fd, PIO_FONT, buf); |
| ret: |
| #endif /* 0 */ |
| free(buf); |
| } |
| |
| static void do_loadtable(int fd, unsigned char *inbuf, int tailsz, int fontsize) |
| { |
| struct unimapinit advice; |
| struct unimapdesc ud; |
| struct unipair *up; |
| int ct = 0, maxct; |
| int glyph; |
| uint16_t unicode; |
| |
| maxct = tailsz; /* more than enough */ |
| up = xmalloc(maxct * sizeof(struct unipair)); |
| |
| for (glyph = 0; glyph < fontsize; glyph++) { |
| while (tailsz >= 2) { |
| unicode = (((uint16_t) inbuf[1]) << 8) + inbuf[0]; |
| tailsz -= 2; |
| inbuf += 2; |
| if (unicode == PSF_SEPARATOR) |
| break; |
| up[ct].unicode = unicode; |
| up[ct].fontpos = glyph; |
| ct++; |
| } |
| } |
| |
| /* Note: after PIO_UNIMAPCLR and before PIO_UNIMAP |
| this printf did not work on many kernels */ |
| |
| advice.advised_hashsize = 0; |
| advice.advised_hashstep = 0; |
| advice.advised_hashlevel = 0; |
| xioctl(fd, PIO_UNIMAPCLR, &advice); |
| ud.entry_ct = ct; |
| ud.entries = up; |
| xioctl(fd, PIO_UNIMAP, &ud); |
| } |
| |
| static void do_load(int fd, struct psf_header *psfhdr, size_t len) |
| { |
| int unit; |
| int fontsize; |
| int hastable; |
| unsigned head0, head = head; |
| |
| /* test for psf first */ |
| if (len >= sizeof(struct psf_header) && PSF_MAGIC_OK(psfhdr)) { |
| if (psfhdr->mode > PSF_MAXMODE) |
| bb_error_msg_and_die("unsupported psf file mode"); |
| fontsize = ((psfhdr->mode & PSF_MODE512) ? 512 : 256); |
| #if !defined(PIO_FONTX) || defined(__sparc__) |
| if (fontsize != 256) |
| bb_error_msg_and_die("only fontsize 256 supported"); |
| #endif |
| hastable = (psfhdr->mode & PSF_MODEHASTAB); |
| unit = psfhdr->charsize; |
| head0 = sizeof(struct psf_header); |
| |
| head = head0 + fontsize * unit; |
| if (head > len || (!hastable && head != len)) |
| bb_error_msg_and_die("input file: bad length"); |
| } else { |
| /* file with three code pages? */ |
| if (len == 9780) { |
| head0 = 40; |
| unit = 16; |
| } else { |
| /* bare font */ |
| if (len & 0377) |
| bb_error_msg_and_die("input file: bad length"); |
| head0 = 0; |
| unit = len / 256; |
| } |
| fontsize = 256; |
| hastable = 0; |
| } |
| |
| do_loadfont(fd, (unsigned char *)psfhdr + head0, unit, fontsize); |
| if (hastable) |
| do_loadtable(fd, (unsigned char *)psfhdr + head, len - head, fontsize); |
| } |
| |
| #if ENABLE_LOADFONT |
| int loadfont_main(int argc, char **argv) MAIN_EXTERNALLY_VISIBLE; |
| int loadfont_main(int argc UNUSED_PARAM, char **argv) |
| { |
| size_t len; |
| struct psf_header *psfhdr; |
| |
| // no arguments allowed! |
| opt_complementary = "=0"; |
| getopt32(argv, ""); |
| |
| /* |
| * We used to look at the length of the input file |
| * with stat(); now that we accept compressed files, |
| * just read the entire file. |
| */ |
| len = 32*1024; // can't be larger |
| psfhdr = (struct psf_header *) xmalloc_read(STDIN_FILENO, &len); |
| // xmalloc_open_zipped_read_close(filename, &len); |
| if (!psfhdr) |
| bb_perror_msg_and_die("error reading input font"); |
| do_load(get_console_fd_or_die(), psfhdr, len); |
| |
| return EXIT_SUCCESS; |
| } |
| #endif |
| |
| #if ENABLE_SETFONT |
| |
| /* |
| kbd-1.12: |
| |
| setfont [-O font+umap.orig] [-o font.orig] [-om cmap.orig] |
| [-ou umap.orig] [-N] [font.new ...] [-m cmap] [-u umap] [-C console] |
| [-hNN] [-v] [-V] |
| |
| -h NN Override font height |
| -o file |
| Save previous font in file |
| -O file |
| Save previous font and Unicode map in file |
| -om file |
| Store console map in file |
| -ou file |
| Save previous Unicode map in file |
| -m file |
| Load console map or Unicode console map from file |
| -u file |
| Load Unicode table describing the font from file |
| Example: |
| # cp866 |
| 0x00-0x7f idem |
| # |
| 0x80 U+0410 # CYRILLIC CAPITAL LETTER A |
| 0x81 U+0411 # CYRILLIC CAPITAL LETTER BE |
| 0x82 U+0412 # CYRILLIC CAPITAL LETTER VE |
| -C console |
| Set the font for the indicated console |
| -v Verbose |
| -V Version |
| */ |
| |
| #if ENABLE_FEATURE_SETFONT_TEXTUAL_MAP |
| static int ctoi(char *s) |
| { |
| if (s[0] == '\'' && s[1] != '\0' && s[2] == '\'' && s[3] == '\0') |
| return s[1]; |
| // U+ means 0x |
| if (s[0] == 'U' && s[1] == '+') { |
| s[0] = '0'; |
| s[1] = 'x'; |
| } |
| if (!isdigit(s[0])) |
| return -1; |
| return xstrtoul(s, 0); |
| } |
| #endif |
| |
| int setfont_main(int argc, char **argv) MAIN_EXTERNALLY_VISIBLE; |
| int setfont_main(int argc UNUSED_PARAM, char **argv) |
| { |
| size_t len; |
| unsigned opts; |
| int fd; |
| struct psf_header *psfhdr; |
| char *mapfilename; |
| const char *tty_name = CURRENT_TTY; |
| |
| opt_complementary = "=1"; |
| opts = getopt32(argv, "m:C:", &mapfilename, &tty_name); |
| argv += optind; |
| |
| fd = xopen(tty_name, O_NONBLOCK); |
| |
| if (sizeof(CONFIG_DEFAULT_SETFONT_DIR) > 1) { // if not "" |
| if (*argv[0] != '/') { |
| // goto default fonts location. don't die if doesn't exist |
| chdir(CONFIG_DEFAULT_SETFONT_DIR "/consolefonts"); |
| } |
| } |
| // load font |
| len = 32*1024; // can't be larger |
| psfhdr = (struct psf_header *) xmalloc_open_zipped_read_close(*argv, &len); |
| if (!psfhdr) |
| bb_simple_perror_msg_and_die(*argv); |
| do_load(fd, psfhdr, len); |
| |
| // load the screen map, if any |
| if (opts & 1) { // -m |
| unsigned mode = PIO_SCRNMAP; |
| void *map; |
| |
| if (sizeof(CONFIG_DEFAULT_SETFONT_DIR) > 1) { // if not "" |
| if (mapfilename[0] != '/') { |
| // goto default keymaps location |
| chdir(CONFIG_DEFAULT_SETFONT_DIR "/consoletrans"); |
| } |
| } |
| // fetch keymap |
| map = xmalloc_open_zipped_read_close(mapfilename, &len); |
| if (!map) |
| bb_simple_perror_msg_and_die(mapfilename); |
| // file size is 256 or 512 bytes? -> assume binary map |
| if (len == E_TABSZ || len == 2*E_TABSZ) { |
| if (len == 2*E_TABSZ) |
| mode = PIO_UNISCRNMAP; |
| } |
| #if ENABLE_FEATURE_SETFONT_TEXTUAL_MAP |
| // assume textual Unicode console maps: |
| // 0x00 U+0000 # NULL (NUL) |
| // 0x01 U+0001 # START OF HEADING (SOH) |
| // 0x02 U+0002 # START OF TEXT (STX) |
| // 0x03 U+0003 # END OF TEXT (ETX) |
| else { |
| int i; |
| char *token[2]; |
| parser_t *parser; |
| |
| if (ENABLE_FEATURE_CLEAN_UP) |
| free(map); |
| map = xmalloc(E_TABSZ * sizeof(unsigned short)); |
| |
| #define unicodes ((unsigned short *)map) |
| // fill vanilla map |
| for (i = 0; i < E_TABSZ; i++) |
| unicodes[i] = 0xf000 + i; |
| |
| parser = config_open(mapfilename); |
| while (config_read(parser, token, 2, 2, "# \t", PARSE_NORMAL | PARSE_MIN_DIE)) { |
| // parse code/value pair |
| int a = ctoi(token[0]); |
| int b = ctoi(token[1]); |
| if (a < 0 || a >= E_TABSZ |
| || b < 0 || b > 65535 |
| ) { |
| bb_error_msg_and_die("map format"); |
| } |
| // patch map |
| unicodes[a] = b; |
| // unicode character is met? |
| if (b > 255) |
| mode = PIO_UNISCRNMAP; |
| } |
| if (ENABLE_FEATURE_CLEAN_UP) |
| config_close(parser); |
| |
| if (mode != PIO_UNISCRNMAP) { |
| #define asciis ((unsigned char *)map) |
| for (i = 0; i < E_TABSZ; i++) |
| asciis[i] = unicodes[i]; |
| #undef asciis |
| } |
| #undef unicodes |
| } |
| #endif // ENABLE_FEATURE_SETFONT_TEXTUAL_MAP |
| |
| // do set screen map |
| xioctl(fd, mode, map); |
| |
| if (ENABLE_FEATURE_CLEAN_UP) |
| free(map); |
| } |
| |
| return EXIT_SUCCESS; |
| } |
| #endif |