gptboot.c revision 41008
1/* 2 * Copyright (c) 1998 Robert Nordier 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms are freely 6 * permitted provided that the above copyright notice and this 7 * paragraph and the following disclaimer are duplicated in all 8 * such forms. 9 * 10 * This software is provided "AS IS" and without any express or 11 * implied warranties, including, without limitation, the implied 12 * warranties of merchantability and fitness for a particular 13 * purpose. 14 */ 15 16/* 17 * $Id: boot2.c,v 1.13 1998/10/27 20:16:36 rnordier Exp $ 18 */ 19 20#include <sys/param.h> 21#include <sys/reboot.h> 22#include <sys/diskslice.h> 23#include <sys/disklabel.h> 24#include <sys/dirent.h> 25#include <machine/bootinfo.h> 26 27#include <ufs/ffs/fs.h> 28#include <ufs/ufs/dinode.h> 29 30#include <stdarg.h> 31 32#include <a.out.h> 33#include <elf.h> 34 35#include <btxv86.h> 36 37#include "lib.h" 38 39#define RBX_ASKNAME 0x0 /* -a */ 40#define RBX_SINGLE 0x1 /* -s */ 41#define RBX_DFLTROOT 0x5 /* -r */ 42#define RBX_KDB 0x6 /* -d */ 43#define RBX_CONFIG 0xa /* -c */ 44#define RBX_VERBOSE 0xb /* -v */ 45#define RBX_SERIAL 0xc /* -h */ 46#define RBX_CDROM 0xd /* -C */ 47#define RBX_GDB 0xf /* -g */ 48#define RBX_DUAL 0x1d /* -D */ 49#define RBX_PROBEKBD 0x1e /* -P */ 50 51#define RBX_MASK 0xffff 52 53#define PATH_CONFIG "/boot.config" 54#define PATH_BOOT3 "/boot/loader" 55#define PATH_KERNEL "/kernel" 56#define PATH_HELP "boot.help" 57 58#define ARGS 0x800 59#define NOPT 11 60#define BSIZEMAX 8192 61#define NDEV 5 62#define MEM_BASE 0x12 63#define MEM_EXT 0x15 64#define V86_CY(x) ((x) & 1) 65#define V86_ZR(x) ((x) & 0x40) 66 67#define DRV_HARD 0x80 68#define DRV_MASK 0x7f 69 70#define MAJ_WD 0 71#define MAJ_WFD 1 72#define MAJ_FD 2 73#define MAJ_DA 4 74 75extern uint32_t _end; 76 77static const char optstr[NOPT] = "DhaCcdgPrsv"; 78static const unsigned char flags[NOPT] = { 79 RBX_DUAL, 80 RBX_SERIAL, 81 RBX_ASKNAME, 82 RBX_CDROM, 83 RBX_CONFIG, 84 RBX_KDB, 85 RBX_GDB, 86 RBX_PROBEKBD, 87 RBX_DFLTROOT, 88 RBX_SINGLE, 89 RBX_VERBOSE 90}; 91 92static const char *const dev_nm[] = {"wd", " ", "fd", " ", "da"}; 93 94static struct dsk { 95 unsigned drive; 96 unsigned type; 97 unsigned unit; 98 unsigned slice; 99 unsigned part; 100 unsigned start; 101 int init; 102 int meta; 103} dsk; 104static char cmd[512]; 105static char kname[1024]; 106static char help[2048]; 107static uint32_t opts; 108static struct bootinfo bootinfo; 109static int ls; 110static uint32_t fs_off; 111static uint8_t ioctrl = 0x1; 112 113void exit(int); 114static void load(const char *); 115static int parse(char *); 116static void readfile(const char *, void *, size_t); 117static ino_t lookup(const char *); 118static int fsfind(const char *, ino_t *); 119static int xfsread(ino_t, void *, size_t); 120static ssize_t fsread(ino_t, void *, size_t); 121static int dskread(void *, unsigned, unsigned); 122static int printf(const char *,...); 123static void getstr(char *, int); 124static int putchar(int); 125static int getchar(void); 126static void *memcpy(void *, const void *, size_t); 127static int strcmp(const char *, const char *); 128static void *malloc(size_t); 129static uint32_t memsize(int); 130static uint32_t drvinfo(int); 131static int drvread(void *, unsigned, unsigned); 132static int keyhit(unsigned); 133static int xputc(int); 134static int xgetc(int); 135static void putc(int); 136static int getc(int); 137 138int 139main(void) 140{ 141 int autoboot, helpon, i; 142 143 v86.ctl = V86_FLAGS; 144 dsk.drive = *(uint8_t *)PTOV(ARGS); 145 dsk.type = dsk.drive & DRV_HARD ? MAJ_WD : MAJ_FD; 146 dsk.unit = dsk.drive & DRV_MASK; 147 dsk.slice = *(uint8_t *)PTOV(ARGS + 1) + 1; 148 bootinfo.bi_version = BOOTINFO_VERSION; 149 bootinfo.bi_size = sizeof(bootinfo); 150 bootinfo.bi_basemem = memsize(MEM_BASE); 151 bootinfo.bi_extmem = memsize(MEM_EXT); 152 bootinfo.bi_memsizes_valid++; 153 for (i = 0; i < N_BIOS_GEOM; i++) 154 bootinfo.bi_bios_geom[i] = drvinfo(i); 155 autoboot = 2; 156 helpon = 1; 157 readfile(PATH_HELP, help, sizeof(help)); 158 readfile(PATH_CONFIG, cmd, sizeof(cmd)); 159 if (*cmd) { 160 printf("%s: %s", PATH_CONFIG, cmd); 161 if (parse(cmd)) 162 autoboot = 0; 163 } 164 if (autoboot && !*kname) { 165 if (autoboot == 2) { 166 memcpy(kname, PATH_BOOT3, sizeof(PATH_BOOT3)); 167 if (!keyhit(0x37)) { 168 load(kname); 169 autoboot = 1; 170 } 171 } 172 if (autoboot == 1) 173 memcpy(kname, PATH_KERNEL, sizeof(PATH_KERNEL)); 174 } 175 for (;;) { 176 printf(" \n>> FreeBSD/i386 BOOT\n" 177 "Default: %u:%s(%u,%c)%s\n" 178 "%s" 179 "boot: ", 180 dsk.drive & DRV_MASK, dev_nm[dsk.type], dsk.unit, 181 'a' + dsk.part, kname, helpon ? help : ""); 182 if (ioctrl & 0x2) 183 sio_flush(); 184 if (!autoboot || keyhit(0x5a)) 185 getstr(cmd, sizeof(cmd)); 186 else 187 putchar('\n'); 188 autoboot = helpon = 0; 189 if (parse(cmd)) 190 helpon = 1; 191 else 192 load(kname); 193 } 194} 195 196void 197exit(int x) 198{ 199} 200 201static void 202load(const char *fname) 203{ 204 union { 205 struct exec ex; 206 Elf32_Ehdr eh; 207 } hdr; 208 Elf32_Phdr ep[2]; 209 Elf32_Shdr es[2]; 210 caddr_t p; 211 ino_t ino; 212 uint32_t addr, x; 213 int fmt, i, j; 214 215 if (!(ino = lookup(fname))) { 216 if (!ls) 217 printf("No %s\n", fname); 218 return; 219 } 220 if (xfsread(ino, &hdr, sizeof(hdr))) 221 return; 222 if (N_GETMAGIC(hdr.ex) == ZMAGIC) 223 fmt = 0; 224 else if (IS_ELF(hdr.eh)) 225 fmt = 1; 226 else { 227 printf("Invalid %s\n", "format"); 228 return; 229 } 230 if (fmt == 0) { 231 addr = hdr.ex.a_entry & 0xffffff; 232 p = PTOV(addr); 233 printf("%s=0x%x ", "text", (unsigned)hdr.ex.a_text); 234 fs_off = PAGE_SIZE; 235 if (xfsread(ino, p, hdr.ex.a_text)) 236 return; 237 p += roundup2(hdr.ex.a_text, PAGE_SIZE); 238 printf("%s=0x%x ", "data", (unsigned)hdr.ex.a_data); 239 if (xfsread(ino, p, hdr.ex.a_data)) 240 return; 241 p += hdr.ex.a_data; 242 printf("%s=0x%x ", "bss", (unsigned)hdr.ex.a_bss); 243 p += roundup2(hdr.ex.a_bss, PAGE_SIZE); 244 bootinfo.bi_symtab = VTOP(p); 245 memcpy(p, &hdr.ex.a_syms, sizeof(hdr.ex.a_syms)); 246 p += sizeof(hdr.ex.a_syms); 247 printf("symbols=["); 248 printf("+0x%x", (unsigned)hdr.ex.a_syms); 249 if (hdr.ex.a_syms) { 250 if (xfsread(ino, p, hdr.ex.a_syms)) 251 return; 252 p += hdr.ex.a_syms; 253 if (xfsread(ino, p, sizeof(int))) 254 return; 255 x = *(uint32_t *)p; 256 p += sizeof(int); 257 x -= sizeof(int); 258 printf("+0x%x", x); 259 if (xfsread(ino, p, x)) 260 return; 261 p += x; 262 } 263 } else { 264 fs_off = hdr.eh.e_phoff; 265 for (j = i = 0; i < hdr.eh.e_phoff && j < 2; i++) { 266 if (xfsread(ino, ep + j, sizeof(ep[0]))) 267 return; 268 if (ep[j].p_type == PT_LOAD) 269 j++; 270 } 271 for (i = 0; i < 2; i++) { 272 p = PTOV(ep[i].p_paddr & 0xffffff); 273 printf("%s=0x%x ", !i ? "text" : "data", ep[i].p_filesz); 274 fs_off = ep[i].p_offset; 275 if (xfsread(ino, p, ep[i].p_filesz)) 276 return; 277 } 278 printf("%s=0x%x ", "bss", ep[1].p_memsz - ep[1].p_filesz); 279 p += roundup2(ep[1].p_memsz, PAGE_SIZE); 280 bootinfo.bi_symtab = VTOP(p); 281 printf("symbols=["); 282 if (hdr.eh.e_shnum == hdr.eh.e_shstrndx + 3) { 283 fs_off = hdr.eh.e_shoff + sizeof(es[0]) * 284 (hdr.eh.e_shstrndx + 1); 285 if (xfsread(ino, &es, sizeof(es))) 286 return; 287 for (i = 0; i < 2; i++) { 288 memcpy(p, &es[i].sh_size, sizeof(es[i].sh_size)); 289 p += sizeof(es[i].sh_size); 290 printf("+0x%x", es[i].sh_size); 291 fs_off = es[i].sh_offset; 292 if (xfsread(ino, p, es[i].sh_size)) 293 return; 294 p += es[i].sh_size; 295 } 296 } 297 addr = hdr.eh.e_entry & 0xffffff; 298 } 299 bootinfo.bi_esymtab = VTOP(p); 300 printf("]\n"); 301 bootinfo.bi_kernelname = VTOP(fname); 302 __exec((caddr_t)addr, RB_BOOTINFO | (opts & RBX_MASK), 303 MAKEBOOTDEV(dsk.type, 0, dsk.slice, dsk.unit, dsk.part), 304 0, 0, 0, VTOP(&bootinfo)); 305} 306 307static int 308parse(char *arg) 309{ 310 char *p, *q; 311 int drv, c, i; 312 313 while ((c = *arg++)) { 314 if (c == ' ') 315 continue; 316 for (p = arg; *p && *p != '\n' && *p != ' '; p++); 317 if (*p) 318 *p++ = 0; 319 if (c == '-') { 320 while ((c = *arg++)) { 321 for (i = 0; c != optstr[i]; i++) 322 if (i == NOPT - 1) 323 return -1; 324 opts ^= 1 << flags[i]; 325 } 326 if (opts & 1 << RBX_PROBEKBD) { 327 i = *(uint8_t *)PTOV(0x496) & 0x10; 328 printf("Keyboard: %s\n", i ? "yes" : "no"); 329 if (!i) 330 opts |= 1 << RBX_DUAL | 1 << RBX_SERIAL; 331 opts &= ~(1 << RBX_PROBEKBD); 332 } 333 ioctrl = opts & 1 << RBX_DUAL ? 0x3 : 334 opts & 1 << RBX_SERIAL ? 0x2 : 0x1; 335 if (ioctrl & 0x2) 336 sio_init(); 337 } else { 338 for (q = arg--; *q && *q != '('; q++); 339 if (*q) { 340 drv = -1; 341 if (arg[1] == ':') { 342 if (*arg < '0' || *arg > '9') 343 return -1; 344 drv = *arg - '0'; 345 arg += 2; 346 } 347 if (q - arg != 2) 348 return -1; 349 for (i = 0; arg[0] != dev_nm[i][0] || 350 arg[1] != dev_nm[i][1]; i++) 351 if (i == NDEV - 1) 352 return -1; 353 dsk.type = i; 354 arg += 3; 355 if (arg[1] != ',' || *arg < '0' || *arg > '9') 356 return -1; 357 dsk.unit = *arg - '0'; 358 arg += 2; 359 dsk.slice = WHOLE_DISK_SLICE; 360 if (arg[1] == ',') { 361 if (*arg < '0' || *arg > '0' + NDOSPART) 362 return -1; 363 if ((dsk.slice = *arg - '0')) 364 dsk.slice++; 365 arg += 2; 366 } 367 if (arg[1] != ')' || *arg < 'a' || *arg > 'p') 368 return -1; 369 dsk.part = *arg - 'a'; 370 arg += 2; 371 if (drv == -1) 372 drv = dsk.unit; 373 dsk.drive = (dsk.type == MAJ_WD || 374 dsk.type == MAJ_DA ? DRV_HARD : 0) + drv; 375 dsk.meta = 0; 376 fsread(0, NULL, 0); 377 } 378 if ((i = p - arg - !*(p - 1))) { 379 if (i >= sizeof(kname)) 380 return -1; 381 memcpy(kname, arg, i + 1); 382 } 383 } 384 arg = p; 385 } 386 return 0; 387} 388 389static void 390readfile(const char *fname, void *buf, size_t size) 391{ 392 ino_t ino; 393 394 if ((ino = lookup(fname))) 395 fsread(ino, buf, size); 396} 397 398static ino_t 399lookup(const char *path) 400{ 401 char name[MAXNAMLEN + 1]; 402 const char *s; 403 ino_t ino; 404 ssize_t n; 405 int dt; 406 407 ino = ROOTINO; 408 dt = DT_DIR; 409 for (;;) { 410 if (*path == '/') 411 path++; 412 if (!*path) 413 break; 414 for (s = path; *s && *s != '/'; s++); 415 if ((n = s - path) > MAXNAMLEN) 416 return 0; 417 ls = *path == '?' && n == 1 && !*s; 418 memcpy(name, path, n); 419 name[n] = 0; 420 if ((dt = fsfind(name, &ino)) <= 0) 421 break; 422 path = s; 423 } 424 return dt == DT_REG ? ino : 0; 425} 426 427static int 428fsfind(const char *name, ino_t * ino) 429{ 430 char buf[DEV_BSIZE]; 431 struct dirent *d; 432 char *s; 433 ssize_t n; 434 435 fs_off = 0; 436 while ((n = fsread(*ino, buf, DEV_BSIZE)) > 0) 437 for (s = buf; s < buf + DEV_BSIZE;) { 438 d = (void *)s; 439 if (ls) 440 printf("%s ", d->d_name); 441 else if (!strcmp(name, d->d_name)) { 442 *ino = d->d_fileno; 443 return d->d_type; 444 } 445 s += d->d_reclen; 446 } 447 if (n != -1 && ls) 448 putchar('\n'); 449 return 0; 450} 451 452static int 453xfsread(ino_t inode, void *buf, size_t nbyte) 454{ 455 if (fsread(inode, buf, nbyte) != nbyte) { 456 printf("Invalid %s\n", "format"); 457 return -1; 458 } 459 return 0; 460} 461 462static ssize_t 463fsread(ino_t inode, void *buf, size_t nbyte) 464{ 465 static struct fs fs; 466 static struct dinode din; 467 static char *blkbuf; 468 static ufs_daddr_t *indbuf; 469 static ino_t inomap; 470 static ufs_daddr_t blkmap, indmap; 471 static unsigned fsblks; 472 char *s; 473 ufs_daddr_t lbn, addr; 474 size_t n, nb, off; 475 476 if (!dsk.meta) { 477 if (!blkbuf) 478 blkbuf = malloc(BSIZEMAX); 479 inomap = 0; 480 if (dskread(blkbuf, SBOFF / DEV_BSIZE, SBSIZE / DEV_BSIZE)) 481 return -1; 482 memcpy(&fs, blkbuf, sizeof(fs)); 483 if (fs.fs_magic != FS_MAGIC) { 484 printf("Not ufs\n"); 485 return -1; 486 } 487 fsblks = fs.fs_bsize >> DEV_BSHIFT; 488 dsk.meta++; 489 } 490 if (!inode) 491 return 0; 492 if (inomap != inode) { 493 if (dskread(blkbuf, fsbtodb(&fs, ino_to_fsba(&fs, inode)), 494 fsblks)) 495 return -1; 496 din = ((struct dinode *)blkbuf)[inode % INOPB(&fs)]; 497 inomap = inode; 498 fs_off = 0; 499 blkmap = indmap = 0; 500 } 501 s = buf; 502 if (nbyte > (n = din.di_size - fs_off)) 503 nbyte = n; 504 nb = nbyte; 505 while (nb) { 506 lbn = lblkno(&fs, fs_off); 507 if (lbn < NDADDR) 508 addr = din.di_db[lbn]; 509 else { 510 if (indmap != din.di_ib[0]) { 511 if (!indbuf) 512 indbuf = malloc(BSIZEMAX); 513 if (dskread(indbuf, fsbtodb(&fs, din.di_ib[0]), 514 fsblks)) 515 return -1; 516 indmap = din.di_ib[0]; 517 } 518 addr = indbuf[(lbn - NDADDR) % NINDIR(&fs)]; 519 } 520 n = dblksize(&fs, &din, lbn); 521 if (blkmap != addr) { 522 if (dskread(blkbuf, fsbtodb(&fs, addr), n >> DEV_BSHIFT)) 523 return -1; 524 blkmap = addr; 525 } 526 off = blkoff(&fs, fs_off); 527 n -= off; 528 if (n > nb) 529 n = nb; 530 memcpy(s, blkbuf + off, n); 531 s += n; 532 fs_off += n; 533 nb -= n; 534 } 535 return nbyte; 536} 537 538static int 539dskread(void *buf, unsigned lba, unsigned nblk) 540{ 541 static char *sec; 542 struct dos_partition *dp; 543 struct disklabel *d; 544 unsigned sl, i; 545 546 if (!dsk.meta) { 547 if (!sec) 548 sec = malloc(DEV_BSIZE); 549 dsk.start = 0; 550 if (drvread(sec, DOSBBSECTOR, 1)) 551 return -1; 552 dp = (void *)(sec + DOSPARTOFF); 553 sl = dsk.slice; 554 if (sl < BASE_SLICE) { 555 for (i = 0; i < NDOSPART; i++) 556 if (dp[i].dp_typ == DOSPTYP_386BSD && 557 (dp[i].dp_flag & 0x80 || sl < BASE_SLICE)) { 558 sl = BASE_SLICE + i; 559 if (dp[i].dp_flag & 0x80 || 560 dsk.slice == COMPATIBILITY_SLICE) 561 break; 562 } 563 if (dsk.slice == WHOLE_DISK_SLICE) 564 dsk.slice = sl; 565 } 566 if (sl != WHOLE_DISK_SLICE) { 567 if (sl != COMPATIBILITY_SLICE) 568 dp += sl - BASE_SLICE; 569 if (dp->dp_typ != DOSPTYP_386BSD) { 570 printf("Invalid %s\n", "slice"); 571 return -1; 572 } 573 dsk.start = dp->dp_start; 574 } 575 if (drvread(sec, dsk.start + LABELSECTOR, 1)) 576 return -1; 577 d = (void *)(sec + LABELOFFSET); 578 if (d->d_magic != DISKMAGIC || d->d_magic2 != DISKMAGIC) { 579 if (dsk.part != RAW_PART) { 580 printf("Invalid %s\n", "label"); 581 return -1; 582 } 583 } else { 584 if (!dsk.init) { 585 if (d->d_type == DTYPE_SCSI) 586 dsk.type = MAJ_DA; 587 dsk.init++; 588 } 589 if (dsk.part >= d->d_npartitions) { 590 printf("Invalid %s\n", "partition"); 591 return -1; 592 } 593 dsk.start = d->d_partitions[dsk.part].p_offset; 594 } 595 } 596 return drvread(buf, dsk.start + lba, nblk); 597} 598 599static int 600printf(const char *fmt,...) 601{ 602 static const char digits[16] = "0123456789abcdef"; 603 va_list ap; 604 char buf[10]; 605 char *s; 606 unsigned r, u; 607 int c; 608 609 va_start(ap, fmt); 610 while ((c = *fmt++)) { 611 if (c == '%') { 612 c = *fmt++; 613 switch (c) { 614 case 'c': 615 putchar(va_arg(ap, int)); 616 continue; 617 case 's': 618 for (s = va_arg(ap, char *); *s; s++) 619 putchar(*s); 620 continue; 621 case 'u': 622 case 'x': 623 r = c == 'u' ? 10U : 16U; 624 u = va_arg(ap, unsigned); 625 s = buf; 626 do 627 *s++ = digits[u % r]; 628 while (u /= r); 629 while (--s >= buf) 630 putchar(*s); 631 continue; 632 } 633 } 634 putchar(c); 635 } 636 va_end(ap); 637 return 0; 638} 639 640static void 641getstr(char *str, int size) 642{ 643 char *s; 644 int c; 645 646 s = str; 647 do { 648 switch (c = getchar()) { 649 case 0: 650 break; 651 case '\b': 652 if (s > str) { 653 s--; 654 putchar(c); 655 putchar(' '); 656 } else 657 c = 0; 658 break; 659 case '\n': 660 *s = 0; 661 break; 662 default: 663 if (s - str < size - 1) 664 *s++ = c; 665 } 666 if (c) 667 putchar(c); 668 } while (c != '\n'); 669} 670 671static int 672putchar(int c) 673{ 674 if (c == '\n') 675 xputc('\r'); 676 return xputc(c); 677} 678 679static int 680getchar(void) 681{ 682 int c; 683 684 c = xgetc(0); 685 if (c == '\r') 686 c = '\n'; 687 return c; 688} 689 690static void * 691memcpy(void *dst, const void *src, size_t size) 692{ 693 const char *s; 694 char *d; 695 696 for (d = dst, s = src; size; size--) 697 *d++ = *s++; 698 return dst; 699} 700 701static int 702strcmp(const char *s1, const char *s2) 703{ 704 for (; *s1 == *s2 && *s1; s1++, s2++); 705 return (u_char)*s1 - (u_char)*s2; 706} 707 708static void * 709malloc(size_t size) 710{ 711 static uint32_t next; 712 void *p; 713 714 if (!next) 715 next = roundup2(__base + _end, 0x10000) - __base; 716 p = (void *)next; 717 next += size; 718 return p; 719} 720 721static uint32_t 722memsize(int type) 723{ 724 v86.addr = type; 725 v86.eax = 0x8800; 726 v86int(); 727 return v86.eax; 728} 729 730static uint32_t 731drvinfo(int drive) 732{ 733 v86.addr = 0x13; 734 v86.eax = 0x800; 735 v86.edx = DRV_HARD + drive; 736 v86int(); 737 if (V86_CY(v86.efl)) 738 return 0x4f010f; 739 return ((v86.ecx & 0xc0) << 18) | ((v86.ecx & 0xff00) << 8) | 740 (v86.edx & 0xff00) | (v86.ecx & 0x3f); 741} 742 743static int 744drvread(void *buf, unsigned lba, unsigned nblk) 745{ 746 static unsigned c = 0x2d5c7c2f; 747 748 printf("%c\b", c = c << 8 | c >> 24); 749 v86.ctl = V86_ADDR | V86_CALLF | V86_FLAGS; 750 v86.addr = 0x604; 751 v86.es = VTOPSEG(buf); 752 v86.eax = lba; 753 v86.ebx = VTOPOFF(buf); 754 v86.ecx = lba >> 16; 755 v86.edx = nblk << 8 | dsk.drive; 756 v86int(); 757 v86.ctl = V86_FLAGS; 758 if (V86_CY(v86.efl)) { 759 printf("Disk error 0x%x (lba=0x%x)\n", v86.eax >> 8 & 0xff, 760 lba); 761 return -1; 762 } 763 return 0; 764} 765 766static int 767keyhit(unsigned ticks) 768{ 769 uint32_t t0, t1; 770 771 t0 = 0; 772 for (;;) { 773 if (xgetc(1)) 774 return 1; 775 t1 = *(uint32_t *)PTOV(0x46c); 776 if (!t0) 777 t0 = t1; 778 if (t1 < t0 || t1 >= t0 + ticks) 779 return 0; 780 } 781} 782 783static int 784xputc(int c) 785{ 786 if (ioctrl & 0x1) 787 putc(c); 788 if (ioctrl & 0x2) 789 sio_putc(c); 790 return c; 791} 792 793static int 794xgetc(int fn) 795{ 796 for (;;) { 797 if (ioctrl & 0x1 && getc(1)) 798 return fn ? 1 : getc(0); 799 if (ioctrl & 0x2 && sio_ischar()) 800 return fn ? 1 : sio_getc(); 801 if (fn) 802 return 0; 803 } 804} 805 806static void 807putc(int c) 808{ 809 v86.addr = 0x10; 810 v86.eax = 0xe00 | (c & 0xff); 811 v86.ebx = 0x7; 812 v86int(); 813} 814 815static int 816getc(int fn) 817{ 818 v86.addr = 0x16; 819 v86.eax = fn << 8; 820 v86int(); 821 return fn == 0 ? v86.eax & 0xff : !V86_ZR(v86.efl); 822} 823