Home | History | Annotate | Line # | Download | only in altboot
main.c revision 1.21.2.3
      1  1.21.2.2       tls /* $NetBSD: main.c,v 1.21.2.3 2017/12/03 11:36:40 jdolecek Exp $ */
      2       1.1  nisimura 
      3       1.1  nisimura /*-
      4       1.1  nisimura  * Copyright (c) 2007 The NetBSD Foundation, Inc.
      5       1.1  nisimura  * All rights reserved.
      6       1.1  nisimura  *
      7       1.1  nisimura  * This code is derived from software contributed to The NetBSD Foundation
      8       1.1  nisimura  * by Tohru Nishimura.
      9       1.1  nisimura  *
     10       1.1  nisimura  * Redistribution and use in source and binary forms, with or without
     11       1.1  nisimura  * modification, are permitted provided that the following conditions
     12       1.1  nisimura  * are met:
     13       1.1  nisimura  * 1. Redistributions of source code must retain the above copyright
     14       1.1  nisimura  *    notice, this list of conditions and the following disclaimer.
     15       1.1  nisimura  * 2. Redistributions in binary form must reproduce the above copyright
     16       1.1  nisimura  *    notice, this list of conditions and the following disclaimer in the
     17       1.1  nisimura  *    documentation and/or other materials provided with the distribution.
     18       1.1  nisimura  *
     19       1.1  nisimura  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20       1.1  nisimura  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21       1.1  nisimura  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22       1.1  nisimura  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23       1.1  nisimura  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24       1.1  nisimura  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25       1.1  nisimura  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26       1.1  nisimura  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27       1.1  nisimura  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28       1.1  nisimura  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29       1.1  nisimura  * POSSIBILITY OF SUCH DAMAGE.
     30       1.1  nisimura  */
     31       1.1  nisimura 
     32       1.1  nisimura #include <sys/param.h>
     33       1.1  nisimura #include <sys/reboot.h>
     34       1.1  nisimura 
     35       1.1  nisimura #include <lib/libsa/stand.h>
     36       1.1  nisimura #include <lib/libsa/loadfile.h>
     37       1.1  nisimura #include <lib/libkern/libkern.h>
     38       1.1  nisimura 
     39       1.1  nisimura #include <machine/bootinfo.h>
     40       1.1  nisimura 
     41       1.1  nisimura #include "globals.h"
     42       1.1  nisimura 
     43       1.1  nisimura static const struct bootarg {
     44       1.1  nisimura 	const char *name;
     45       1.1  nisimura 	int value;
     46       1.1  nisimura } bootargs[] = {
     47       1.1  nisimura 	{ "multi",	RB_AUTOBOOT },
     48       1.1  nisimura 	{ "auto",	RB_AUTOBOOT },
     49       1.1  nisimura 	{ "ask",	RB_ASKNAME },
     50       1.1  nisimura 	{ "single",	RB_SINGLE },
     51       1.1  nisimura 	{ "ddb",	RB_KDB },
     52       1.1  nisimura 	{ "userconf",	RB_USERCONF },
     53       1.1  nisimura 	{ "norm",	AB_NORMAL },
     54       1.1  nisimura 	{ "quiet",	AB_QUIET },
     55       1.1  nisimura 	{ "verb",	AB_VERBOSE },
     56       1.1  nisimura 	{ "silent",	AB_SILENT },
     57      1.12       phx 	{ "debug",	AB_DEBUG },
     58      1.12       phx 	{ "altboot",	-1 }
     59       1.1  nisimura };
     60       1.1  nisimura 
     61      1.17       phx /* default PATA drive configuration is "10": single master on first channel */
     62      1.17       phx static char *drive_config = "10";
     63      1.17       phx 
     64       1.1  nisimura void *bootinfo; /* low memory reserved to pass bootinfo structures */
     65       1.1  nisimura int bi_size;	/* BOOTINFO_MAXSIZE */
     66       1.1  nisimura char *bi_next;
     67       1.1  nisimura 
     68       1.1  nisimura void bi_init(void *);
     69       1.1  nisimura void bi_add(void *, int, int);
     70       1.1  nisimura 
     71       1.1  nisimura struct btinfo_memory bi_mem;
     72       1.1  nisimura struct btinfo_console bi_cons;
     73       1.1  nisimura struct btinfo_clock bi_clk;
     74       1.1  nisimura struct btinfo_prodfamily bi_fam;
     75  1.21.2.3  jdolecek struct btinfo_model bi_model;
     76       1.1  nisimura struct btinfo_bootpath bi_path;
     77       1.1  nisimura struct btinfo_rootdevice bi_rdev;
     78       1.1  nisimura struct btinfo_net bi_net;
     79       1.1  nisimura struct btinfo_modulelist *btinfo_modulelist;
     80       1.1  nisimura size_t btinfo_modulelist_size;
     81       1.1  nisimura 
     82       1.1  nisimura struct boot_module {
     83       1.1  nisimura 	char *bm_kmod;
     84       1.1  nisimura 	ssize_t bm_len;
     85       1.1  nisimura 	struct boot_module *bm_next;
     86       1.1  nisimura };
     87       1.1  nisimura struct boot_module *boot_modules;
     88       1.1  nisimura char module_base[80];
     89       1.1  nisimura uint32_t kmodloadp;
     90       1.1  nisimura int modules_enabled = 0;
     91       1.1  nisimura 
     92  1.21.2.2       tls void module_add(const char *);
     93  1.21.2.2       tls void module_load(const char *);
     94       1.1  nisimura int module_open(struct boot_module *);
     95       1.1  nisimura 
     96       1.7       phx void main(int, char **, char *, char *);
     97      1.12       phx 
     98       1.4  nisimura extern char bootprog_name[], bootprog_rev[];
     99      1.12       phx extern char newaltboot[], newaltboot_end[];
    100       1.1  nisimura 
    101       1.6  nisimura struct pcidev lata[2];
    102      1.16       phx struct pcidev lnif[2];
    103       1.6  nisimura struct pcidev lusb[3];
    104       1.6  nisimura int nata, nnif, nusb;
    105       1.6  nisimura 
    106       1.1  nisimura int brdtype;
    107       1.1  nisimura uint32_t busclock, cpuclock;
    108       1.1  nisimura 
    109       1.1  nisimura static int check_bootname(char *);
    110      1.11       phx static int input_cmdline(char **, int);
    111       1.7       phx static int parse_cmdline(char **, int, char *, char *);
    112       1.7       phx static int is_space(char);
    113      1.15       phx #ifdef DEBUG
    114      1.15       phx static void sat_test(void);
    115  1.21.2.1       tls static void findflash(void);
    116      1.15       phx #endif
    117       1.7       phx 
    118      1.12       phx #define	BNAME_DEFAULT "wd0:"
    119       1.7       phx #define MAX_ARGS 10
    120       1.1  nisimura 
    121       1.1  nisimura void
    122       1.7       phx main(int argc, char *argv[], char *bootargs_start, char *bootargs_end)
    123       1.1  nisimura {
    124      1.19       phx 	unsigned long marks[MARK_MAX];
    125       1.1  nisimura 	struct brdprop *brdprop;
    126       1.7       phx 	char *new_argv[MAX_ARGS];
    127      1.19       phx 	char *bname;
    128      1.12       phx 	ssize_t len;
    129      1.19       phx 	int err, fd, howto, i, n;
    130       1.1  nisimura 
    131      1.19       phx 	printf("\n>> %s altboot, revision %s\n", bootprog_name, bootprog_rev);
    132       1.1  nisimura 
    133       1.1  nisimura 	brdprop = brd_lookup(brdtype);
    134       1.3       phx 	printf(">> %s, cpu %u MHz, bus %u MHz, %dMB SDRAM\n", brdprop->verbose,
    135       1.1  nisimura 	    cpuclock / 1000000, busclock / 1000000, bi_mem.memsize >> 20);
    136       1.1  nisimura 
    137       1.6  nisimura 	nata = pcilookup(PCI_CLASS_IDE, lata, 2);
    138       1.6  nisimura 	if (nata == 0)
    139      1.14       phx 		nata = pcilookup(PCI_CLASS_RAID, lata, 2);
    140      1.14       phx 	if (nata == 0)
    141       1.6  nisimura 		nata = pcilookup(PCI_CLASS_MISCSTORAGE, lata, 2);
    142       1.8       phx 	if (nata == 0)
    143       1.8       phx 		nata = pcilookup(PCI_CLASS_SCSI, lata, 2);
    144      1.16       phx 	nnif = pcilookup(PCI_CLASS_ETH, lnif, 2);
    145       1.6  nisimura 	nusb = pcilookup(PCI_CLASS_USB, lusb, 3);
    146       1.6  nisimura 
    147       1.6  nisimura #ifdef DEBUG
    148       1.6  nisimura 	if (nata == 0)
    149       1.6  nisimura 		printf("No IDE/SATA found\n");
    150       1.6  nisimura 	else for (n = 0; n < nata; n++) {
    151       1.6  nisimura 		int b, d, f, bdf, pvd;
    152       1.6  nisimura 		bdf = lata[n].bdf;
    153       1.6  nisimura 		pvd = lata[n].pvd;
    154       1.6  nisimura 		pcidecomposetag(bdf, &b, &d, &f);
    155       1.6  nisimura 		printf("%04x.%04x DSK %02d:%02d:%02d\n",
    156       1.6  nisimura 		    PCI_VENDOR(pvd), PCI_PRODUCT(pvd), b, d, f);
    157       1.1  nisimura 	}
    158       1.6  nisimura 	if (nnif == 0)
    159       1.6  nisimura 		printf("no NET found\n");
    160      1.16       phx 	else for (n = 0; n < nnif; n++) {
    161       1.6  nisimura 		int b, d, f, bdf, pvd;
    162      1.16       phx 		bdf = lnif[n].bdf;
    163      1.16       phx 		pvd = lnif[n].pvd;
    164       1.6  nisimura 		pcidecomposetag(bdf, &b, &d, &f);
    165       1.6  nisimura 		printf("%04x.%04x NET %02d:%02d:%02d\n",
    166       1.6  nisimura 		    PCI_VENDOR(pvd), PCI_PRODUCT(pvd), b, d, f);
    167       1.6  nisimura 	}
    168       1.6  nisimura 	if (nusb == 0)
    169       1.6  nisimura 		printf("no USB found\n");
    170       1.6  nisimura 	else for (n = 0; n < nusb; n++) {
    171       1.6  nisimura 		int b, d, f, bdf, pvd;
    172       1.6  nisimura 		bdf = lusb[0].bdf;
    173       1.6  nisimura 		pvd = lusb[0].pvd;
    174       1.6  nisimura 		pcidecomposetag(bdf, &b, &d, &f);
    175       1.6  nisimura 		printf("%04x.%04x USB %02d:%02d:%02d\n",
    176       1.6  nisimura 		    PCI_VENDOR(pvd), PCI_PRODUCT(pvd), b, d, f);
    177       1.1  nisimura 	}
    178       1.6  nisimura #endif
    179       1.1  nisimura 
    180       1.1  nisimura 	pcisetup();
    181       1.1  nisimura 	pcifixup();
    182       1.1  nisimura 
    183       1.7       phx 	/*
    184       1.7       phx 	 * When argc is too big then it is probably a pointer, which could
    185       1.7       phx 	 * indicate that we were launched as a Linux kernel module using
    186       1.7       phx 	 * "bootm".
    187       1.7       phx 	 */
    188       1.7       phx 	if (argc > MAX_ARGS) {
    189      1.13       phx 		if (argv != NULL) {
    190      1.13       phx 			/*
    191      1.17       phx 			 * initrd image was loaded:
    192      1.17       phx 			 * check if it contains a valid altboot command line
    193      1.13       phx 			 */
    194      1.17       phx 			char *p = (char *)argv;
    195      1.17       phx 
    196      1.17       phx 			if (strncmp(p, "altboot:", 8) == 0) {
    197      1.17       phx 				*p = 0;
    198      1.17       phx 				for (p = p + 8; *p >= ' '; p++);
    199      1.17       phx 				argc = parse_cmdline(new_argv, MAX_ARGS,
    200      1.17       phx 				    ((char *)argv) + 8, p);
    201      1.17       phx 				argv = new_argv;
    202      1.17       phx 			} else
    203      1.17       phx 				argc = 0;	/* boot default */
    204      1.13       phx 		} else {
    205      1.13       phx 			/* parse standard Linux bootargs */
    206      1.13       phx 			argc = parse_cmdline(new_argv, MAX_ARGS,
    207      1.13       phx 			    bootargs_start, bootargs_end);
    208      1.13       phx 			argv = new_argv;
    209      1.13       phx 		}
    210       1.7       phx 	}
    211       1.7       phx 
    212      1.17       phx 	/* look for a PATA drive configuration string under the arguments */
    213      1.17       phx 	for (n = 1; n < argc; n++) {
    214      1.17       phx 		if (strncmp(argv[n], "ide:", 4) == 0 &&
    215      1.17       phx 		    argv[n][4] >= '0' && argv[n][4] <= '2') {
    216      1.17       phx 			drive_config = &argv[n][4];
    217      1.17       phx 			break;
    218      1.17       phx 		}
    219      1.17       phx 	}
    220      1.17       phx 
    221      1.17       phx 	/* intialize a disk driver */
    222      1.18       phx 	for (i = 0, n = 0; i < nata; i++)
    223      1.18       phx 		n += dskdv_init(&lata[i]);
    224      1.18       phx 	if (n == 0)
    225      1.17       phx 		printf("IDE/SATA device driver was not found\n");
    226      1.17       phx 
    227      1.17       phx 	/* initialize a network interface */
    228      1.17       phx 	for (n = 0; n < nnif; n++)
    229      1.17       phx 		if (netif_init(&lnif[n]) != 0)
    230      1.17       phx 			break;
    231      1.17       phx 	if (n >= nnif)
    232      1.17       phx 		printf("no NET device driver was found\n");
    233      1.17       phx 
    234      1.11       phx 	/* wait 2s for user to enter interactive mode */
    235      1.11       phx 	for (n = 200; n >= 0; n--) {
    236      1.11       phx 		if (n % 100 == 0)
    237      1.19       phx 			printf("\rHit any key to enter interactive mode: %d",
    238      1.11       phx 			    n / 100);
    239      1.11       phx 		if (tstchar()) {
    240      1.15       phx #ifdef DEBUG
    241  1.21.2.1       tls 			unsigned c;
    242  1.21.2.1       tls 
    243  1.21.2.1       tls 			c = toupper(getchar());
    244  1.21.2.1       tls 			if (c == 'C') {
    245      1.15       phx 				/* controller test terminal */
    246      1.15       phx 				sat_test();
    247      1.15       phx 				n = 200;
    248      1.15       phx 				continue;
    249      1.15       phx 			}
    250  1.21.2.1       tls 			else if (c == 'F') {
    251  1.21.2.1       tls 				/* find strings in Flash ROM */
    252  1.21.2.1       tls 				findflash();
    253  1.21.2.1       tls 				n = 200;
    254  1.21.2.1       tls 				continue;
    255  1.21.2.1       tls 			}
    256      1.15       phx #else
    257      1.11       phx 			(void)getchar();
    258      1.15       phx #endif
    259      1.15       phx 			/* enter command line */
    260      1.11       phx 			argv = new_argv;
    261      1.11       phx 			argc = input_cmdline(argv, MAX_ARGS);
    262      1.11       phx 			break;
    263      1.11       phx 		}
    264      1.11       phx 		delay(10000);
    265      1.11       phx 	}
    266      1.11       phx 	putchar('\n');
    267      1.11       phx 
    268       1.1  nisimura 	howto = RB_AUTOBOOT;		/* default is autoboot = 0 */
    269       1.1  nisimura 
    270       1.1  nisimura 	/* get boot options and determine bootname */
    271       1.1  nisimura 	for (n = 1; n < argc; n++) {
    272      1.17       phx 		if (strncmp(argv[n], "ide:", 4) == 0)
    273      1.17       phx 			continue; /* ignore drive configuration argument */
    274      1.17       phx 
    275       1.1  nisimura 		for (i = 0; i < sizeof(bootargs) / sizeof(bootargs[0]); i++) {
    276       1.1  nisimura 			if (strncasecmp(argv[n], bootargs[i].name,
    277       1.1  nisimura 			    strlen(bootargs[i].name)) == 0) {
    278       1.1  nisimura 				howto |= bootargs[i].value;
    279       1.1  nisimura 				break;
    280       1.1  nisimura 			}
    281       1.1  nisimura 		}
    282       1.1  nisimura 		if (i >= sizeof(bootargs) / sizeof(bootargs[0]))
    283       1.1  nisimura 			break;	/* break on first unknown string */
    284       1.1  nisimura 	}
    285      1.19       phx 
    286      1.20  nisimura 	/*
    287      1.20  nisimura 	 * If no device name is given, we construct a list of drives
    288      1.20  nisimura 	 * which have valid disklabels.
    289      1.20  nisimura 	 */
    290      1.19       phx 	if (n >= argc) {
    291  1.21.2.2       tls 		static const size_t blen = sizeof("wdN:");
    292      1.19       phx 		n = 0;
    293      1.19       phx 		argc = 0;
    294  1.21.2.2       tls 		argv = alloc(MAX_UNITS * (sizeof(char *) + blen));
    295      1.19       phx 		bname = (char *)(argv + MAX_UNITS);
    296      1.19       phx 		for (i = 0; i < MAX_UNITS; i++) {
    297      1.19       phx 			if (!dlabel_valid(i))
    298      1.19       phx 				continue;
    299  1.21.2.2       tls 			snprintf(bname, blen, "wd%d:", i);
    300      1.19       phx 			argv[argc++] = bname;
    301  1.21.2.2       tls 			bname += blen;
    302      1.19       phx 		}
    303      1.19       phx 		/* use default drive if no valid disklabel is found */
    304      1.19       phx 		if (argc == 0) {
    305      1.19       phx 			argc = 1;
    306      1.19       phx 			argv[0] = BNAME_DEFAULT;
    307      1.19       phx 		}
    308      1.19       phx 	}
    309      1.19       phx 
    310      1.20  nisimura 	/* try to boot off kernel from the drive list */
    311      1.19       phx 	while (n < argc) {
    312      1.19       phx 		bname = argv[n++];
    313      1.19       phx 
    314       1.1  nisimura 		if (check_bootname(bname) == 0) {
    315       1.1  nisimura 			printf("%s not a valid bootname\n", bname);
    316      1.19       phx 			continue;
    317       1.1  nisimura 		}
    318       1.1  nisimura 
    319      1.19       phx 		if ((fd = open(bname, 0)) < 0) {
    320      1.19       phx 			if (errno == ENOENT)
    321      1.19       phx 				printf("\"%s\" not found\n", bi_path.bootpath);
    322      1.19       phx 			continue;
    323      1.19       phx 		}
    324      1.19       phx 		printf("loading \"%s\" ", bi_path.bootpath);
    325      1.19       phx 		marks[MARK_START] = 0;
    326      1.19       phx 
    327      1.19       phx 		if (howto == -1) {
    328      1.19       phx 			/* load another altboot binary and replace ourselves */
    329      1.19       phx 			len = read(fd, (void *)0x100000, 0x1000000 - 0x100000);
    330      1.19       phx 			if (len == -1)
    331      1.19       phx 				goto loadfail;
    332      1.19       phx 			close(fd);
    333      1.19       phx 			netif_shutdown_all();
    334      1.19       phx 
    335      1.19       phx 			memcpy((void *)0xf0000, newaltboot,
    336      1.19       phx 			    newaltboot_end - newaltboot);
    337      1.19       phx 			__syncicache((void *)0xf0000,
    338      1.19       phx 			    newaltboot_end - newaltboot);
    339      1.19       phx 			printf("Restarting...\n");
    340      1.19       phx 			run((void *)1, argv, (void *)0x100000, (void *)len,
    341      1.19       phx 			    (void *)0xf0000);
    342      1.19       phx 		}
    343      1.12       phx 
    344      1.19       phx 		err = fdloadfile(fd, marks, LOAD_KERNEL);
    345      1.12       phx 		close(fd);
    346      1.19       phx 		if (err < 0)
    347      1.19       phx 			continue;
    348      1.12       phx 
    349      1.19       phx 		printf("entry=%p, ssym=%p, esym=%p\n",
    350      1.19       phx 		    (void *)marks[MARK_ENTRY],
    351      1.19       phx 		    (void *)marks[MARK_SYM],
    352      1.19       phx 		    (void *)marks[MARK_END]);
    353      1.19       phx 
    354      1.19       phx 		bootinfo = (void *)0x4000;
    355      1.19       phx 		bi_init(bootinfo);
    356      1.19       phx 		bi_add(&bi_cons, BTINFO_CONSOLE, sizeof(bi_cons));
    357      1.19       phx 		bi_add(&bi_mem, BTINFO_MEMORY, sizeof(bi_mem));
    358      1.19       phx 		bi_add(&bi_clk, BTINFO_CLOCK, sizeof(bi_clk));
    359      1.19       phx 		bi_add(&bi_path, BTINFO_BOOTPATH, sizeof(bi_path));
    360      1.19       phx 		bi_add(&bi_rdev, BTINFO_ROOTDEVICE, sizeof(bi_rdev));
    361      1.19       phx 		bi_add(&bi_fam, BTINFO_PRODFAMILY, sizeof(bi_fam));
    362      1.19       phx 		if (brdtype == BRD_SYNOLOGY || brdtype == BRD_DLINKDSM) {
    363      1.19       phx 			/* need to pass this MAC address to kernel */
    364      1.19       phx 			bi_add(&bi_net, BTINFO_NET, sizeof(bi_net));
    365      1.19       phx 		}
    366  1.21.2.3  jdolecek 		bi_add(&bi_model, BTINFO_MODEL, sizeof(bi_model));
    367      1.10       phx 
    368      1.19       phx 		if (modules_enabled) {
    369      1.21       dsl 			if (fsmod != NULL)
    370      1.21       dsl 				module_add(fsmod);
    371      1.19       phx 			kmodloadp = marks[MARK_END];
    372      1.19       phx 			btinfo_modulelist = NULL;
    373      1.19       phx 			module_load(bname);
    374      1.19       phx 			if (btinfo_modulelist != NULL &&
    375      1.19       phx 			    btinfo_modulelist->num > 0)
    376      1.19       phx 				bi_add(btinfo_modulelist, BTINFO_MODULELIST,
    377      1.19       phx 				    btinfo_modulelist_size);
    378      1.19       phx 		}
    379       1.1  nisimura 
    380      1.19       phx 		launchfixup();
    381      1.19       phx 		netif_shutdown_all();
    382       1.1  nisimura 
    383      1.19       phx 		__syncicache((void *)marks[MARK_ENTRY],
    384      1.19       phx 		    (u_int)marks[MARK_SYM] - (u_int)marks[MARK_ENTRY]);
    385      1.19       phx 
    386      1.19       phx 		run((void *)marks[MARK_SYM], (void *)marks[MARK_END],
    387      1.19       phx 		    (void *)howto, bootinfo, (void *)marks[MARK_ENTRY]);
    388       1.1  nisimura 
    389      1.19       phx 		/* should never come here */
    390      1.19       phx 		printf("exec returned. Restarting...\n");
    391      1.19       phx 		_rtt();
    392      1.19       phx 	}
    393       1.1  nisimura   loadfail:
    394       1.1  nisimura 	printf("load failed. Restarting...\n");
    395       1.1  nisimura 	_rtt();
    396       1.1  nisimura }
    397       1.1  nisimura 
    398       1.1  nisimura void
    399       1.1  nisimura bi_init(void *addr)
    400       1.1  nisimura {
    401       1.1  nisimura 	struct btinfo_magic bi_magic;
    402       1.1  nisimura 
    403       1.1  nisimura 	memset(addr, 0, BOOTINFO_MAXSIZE);
    404       1.1  nisimura 	bi_next = (char *)addr;
    405       1.1  nisimura 	bi_size = 0;
    406       1.1  nisimura 
    407       1.1  nisimura 	bi_magic.magic = BOOTINFO_MAGIC;
    408       1.1  nisimura 	bi_add(&bi_magic, BTINFO_MAGIC, sizeof(bi_magic));
    409       1.1  nisimura }
    410       1.1  nisimura 
    411       1.1  nisimura void
    412       1.1  nisimura bi_add(void *new, int type, int size)
    413       1.1  nisimura {
    414       1.1  nisimura 	struct btinfo_common *bi;
    415       1.1  nisimura 
    416       1.1  nisimura 	if (bi_size + size > BOOTINFO_MAXSIZE)
    417       1.1  nisimura 		return;				/* XXX error? */
    418       1.1  nisimura 
    419       1.1  nisimura 	bi = new;
    420       1.1  nisimura 	bi->next = size;
    421       1.1  nisimura 	bi->type = type;
    422       1.1  nisimura 	memcpy(bi_next, new, size);
    423       1.1  nisimura 	bi_next += size;
    424       1.1  nisimura }
    425       1.1  nisimura 
    426       1.1  nisimura void
    427  1.21.2.2       tls module_add(const char *name)
    428       1.1  nisimura {
    429       1.1  nisimura 	struct boot_module *bm, *bmp;
    430       1.1  nisimura 
    431       1.1  nisimura 	while (*name == ' ' || *name == '\t')
    432       1.1  nisimura 		++name;
    433       1.1  nisimura 
    434       1.1  nisimura 	bm = alloc(sizeof(struct boot_module) + strlen(name) + 1);
    435       1.1  nisimura 	if (bm == NULL) {
    436  1.21.2.2       tls 		printf("couldn't allocate module %s\n", name);
    437  1.21.2.2       tls 		return;
    438       1.1  nisimura 	}
    439       1.1  nisimura 
    440       1.1  nisimura 	bm->bm_kmod = (char *)(bm + 1);
    441       1.1  nisimura 	bm->bm_len = -1;
    442       1.1  nisimura 	bm->bm_next = NULL;
    443       1.1  nisimura 	strcpy(bm->bm_kmod, name);
    444       1.1  nisimura 	if ((bmp = boot_modules) == NULL)
    445       1.1  nisimura 		boot_modules = bm;
    446       1.1  nisimura 	else {
    447       1.1  nisimura 		while (bmp->bm_next != NULL)
    448       1.1  nisimura 			bmp = bmp->bm_next;
    449       1.1  nisimura 		bmp->bm_next = bm;
    450       1.1  nisimura 	}
    451       1.1  nisimura }
    452       1.1  nisimura 
    453       1.1  nisimura #define PAGE_SIZE	4096
    454       1.1  nisimura #define alignpg(x)	(((x)+PAGE_SIZE-1) & ~(PAGE_SIZE-1))
    455       1.1  nisimura 
    456       1.1  nisimura void
    457  1.21.2.2       tls module_load(const char *kernel_path)
    458       1.1  nisimura {
    459       1.1  nisimura 	struct boot_module *bm;
    460       1.1  nisimura 	struct bi_modulelist_entry *bi;
    461       1.1  nisimura 	struct stat st;
    462  1.21.2.2       tls 	char *p;
    463       1.1  nisimura 	int size, fd;
    464       1.1  nisimura 
    465       1.1  nisimura 	strcpy(module_base, kernel_path);
    466       1.1  nisimura 	if ((p = strchr(module_base, ':')) == NULL)
    467       1.1  nisimura 		return; /* eeh?! */
    468       1.1  nisimura 	p += 1;
    469       1.1  nisimura 	size = sizeof(module_base) - (p - module_base);
    470       1.1  nisimura 
    471       1.1  nisimura 	if (netbsd_version / 1000000 % 100 == 99) {
    472       1.1  nisimura 		/* -current */
    473       1.1  nisimura 		snprintf(p, size,
    474       1.1  nisimura 		    "/stand/sandpoint/%d.%d.%d/modules",
    475       1.1  nisimura 		    netbsd_version / 100000000,
    476       1.1  nisimura 		    netbsd_version / 1000000 % 100,
    477       1.1  nisimura 		    netbsd_version / 100 % 100);
    478       1.1  nisimura 	}
    479       1.1  nisimura 	 else if (netbsd_version != 0) {
    480       1.1  nisimura 		/* release */
    481       1.1  nisimura 		snprintf(p, size,
    482       1.1  nisimura 		    "/stand/sandpoint/%d.%d/modules",
    483       1.1  nisimura 		    netbsd_version / 100000000,
    484       1.1  nisimura 		    netbsd_version / 1000000 % 100);
    485       1.1  nisimura 	}
    486       1.1  nisimura 
    487       1.1  nisimura 	/*
    488       1.1  nisimura 	 * 1st pass; determine module existence
    489       1.1  nisimura 	 */
    490       1.1  nisimura 	size = 0;
    491       1.1  nisimura 	for (bm = boot_modules; bm != NULL; bm = bm->bm_next) {
    492       1.1  nisimura 		fd = module_open(bm);
    493       1.1  nisimura 		if (fd == -1)
    494       1.1  nisimura 			continue;
    495       1.1  nisimura 		if (fstat(fd, &st) == -1 || st.st_size == -1) {
    496       1.1  nisimura 			printf("WARNING: couldn't stat %s\n", bm->bm_kmod);
    497       1.1  nisimura 			close(fd);
    498       1.1  nisimura 			continue;
    499       1.1  nisimura 		}
    500       1.1  nisimura 		bm->bm_len = (int)st.st_size;
    501       1.1  nisimura 		close(fd);
    502  1.21.2.2       tls 		size += sizeof(struct bi_modulelist_entry);
    503       1.1  nisimura 	}
    504       1.1  nisimura 	if (size == 0)
    505       1.1  nisimura 		return;
    506       1.1  nisimura 
    507       1.1  nisimura 	size += sizeof(struct btinfo_modulelist);
    508       1.1  nisimura 	btinfo_modulelist = alloc(size);
    509       1.1  nisimura 	if (btinfo_modulelist == NULL) {
    510       1.1  nisimura 		printf("WARNING: couldn't allocate module list\n");
    511       1.1  nisimura 		return;
    512       1.1  nisimura 	}
    513       1.1  nisimura 	btinfo_modulelist_size = size;
    514       1.1  nisimura 	btinfo_modulelist->num = 0;
    515       1.1  nisimura 
    516       1.1  nisimura 	/*
    517       1.1  nisimura 	 * 2nd pass; load modules into memory
    518       1.1  nisimura 	 */
    519       1.1  nisimura 	kmodloadp = alignpg(kmodloadp);
    520       1.1  nisimura 	bi = (struct bi_modulelist_entry *)(btinfo_modulelist + 1);
    521       1.1  nisimura 	for (bm = boot_modules; bm != NULL; bm = bm->bm_next) {
    522       1.1  nisimura 		if (bm->bm_len == -1)
    523       1.1  nisimura 			continue; /* already found unavailable */
    524       1.1  nisimura 		fd = module_open(bm);
    525       1.1  nisimura 		printf("module \"%s\" ", bm->bm_kmod);
    526       1.1  nisimura 		size = read(fd, (char *)kmodloadp, SSIZE_MAX);
    527       1.1  nisimura 		if (size < bm->bm_len)
    528       1.1  nisimura 			printf("WARNING: couldn't load");
    529       1.1  nisimura 		else {
    530  1.21.2.2       tls 			snprintf(bi->kmod, sizeof(bi->kmod), "%s", bm->bm_kmod);
    531       1.1  nisimura 			bi->type = BI_MODULE_ELF;
    532       1.1  nisimura 			bi->len = size;
    533       1.1  nisimura 			bi->base = kmodloadp;
    534       1.1  nisimura 			btinfo_modulelist->num += 1;
    535       1.1  nisimura 			printf("loaded at 0x%08x size 0x%x", kmodloadp, size);
    536       1.1  nisimura 			kmodloadp += alignpg(size);
    537       1.1  nisimura 			bi += 1;
    538       1.1  nisimura 		}
    539       1.1  nisimura 		printf("\n");
    540       1.1  nisimura 		close(fd);
    541       1.1  nisimura 	}
    542       1.1  nisimura 	btinfo_modulelist->endpa = kmodloadp;
    543       1.1  nisimura }
    544       1.1  nisimura 
    545       1.1  nisimura int
    546       1.1  nisimura module_open(struct boot_module *bm)
    547       1.1  nisimura {
    548       1.1  nisimura 	char path[80];
    549       1.1  nisimura 	int fd;
    550       1.1  nisimura 
    551       1.1  nisimura 	snprintf(path, sizeof(path),
    552       1.1  nisimura 	    "%s/%s/%s.kmod", module_base, bm->bm_kmod, bm->bm_kmod);
    553       1.1  nisimura 	fd = open(path, 0);
    554       1.1  nisimura 	return fd;
    555       1.1  nisimura }
    556       1.1  nisimura 
    557      1.17       phx /*
    558      1.17       phx  * Return the drive configuration for the requested channel 'ch'.
    559      1.17       phx  * Channel 2 is the first channel of the next IDE controller.
    560      1.17       phx  * 0: for no drive present on channel
    561      1.17       phx  * 1: for master drive present on channel, no slave
    562      1.17       phx  * 2: for master and slave drive present
    563      1.17       phx  */
    564      1.17       phx int
    565      1.17       phx get_drive_config(int ch)
    566       1.1  nisimura {
    567      1.17       phx 	if (drive_config != NULL) {
    568      1.17       phx 		if (strlen(drive_config) <= ch)
    569      1.17       phx 			return 0;	/* an unspecified channel is unused */
    570      1.17       phx 		if (drive_config[ch] >= '0' && drive_config[ch] <= '2')
    571      1.17       phx 			return drive_config[ch] - '0';
    572      1.17       phx 	}
    573      1.17       phx 	return -1;
    574       1.1  nisimura }
    575       1.1  nisimura 
    576       1.1  nisimura void *
    577       1.1  nisimura allocaligned(size_t size, size_t align)
    578       1.1  nisimura {
    579       1.1  nisimura 	uint32_t p;
    580       1.1  nisimura 
    581       1.1  nisimura 	if (align-- < 2)
    582       1.1  nisimura 		return alloc(size);
    583       1.1  nisimura 	p = (uint32_t)alloc(size + align);
    584       1.1  nisimura 	return (void *)((p + align) & ~align);
    585       1.1  nisimura }
    586       1.1  nisimura 
    587       1.9       phx static int hex2nibble(char c)
    588       1.9       phx {
    589       1.9       phx 
    590       1.9       phx 	if (c >= 'a')
    591       1.9       phx 		c &= ~0x20;
    592       1.9       phx 	if (c >= 'A' && c <= 'F')
    593       1.9       phx 		c -= 'A' - ('9' + 1);
    594       1.9       phx 	else if (c < '0' || c > '9')
    595       1.9       phx 		return -1;
    596       1.9       phx 
    597       1.9       phx 	return c - '0';
    598       1.9       phx }
    599       1.9       phx 
    600       1.9       phx uint32_t
    601       1.9       phx read_hex(const char *s)
    602       1.9       phx {
    603       1.9       phx 	int n;
    604       1.9       phx 	uint32_t val;
    605       1.9       phx 
    606       1.9       phx 	val = 0;
    607       1.9       phx 	while ((n = hex2nibble(*s++)) >= 0)
    608       1.9       phx 		val = (val << 4) | n;
    609       1.9       phx 	return val;
    610       1.9       phx }
    611       1.9       phx 
    612       1.1  nisimura static int
    613       1.1  nisimura check_bootname(char *s)
    614       1.1  nisimura {
    615       1.1  nisimura 	/*
    616       1.1  nisimura 	 * nfs:
    617       1.1  nisimura 	 * nfs:<bootfile>
    618       1.1  nisimura 	 * tftp:
    619       1.1  nisimura 	 * tftp:<bootfile>
    620       1.1  nisimura 	 * wd[N[P]]:<bootfile>
    621       1.9       phx 	 * mem:<address>
    622       1.1  nisimura 	 *
    623       1.1  nisimura 	 * net is a synonym of nfs.
    624       1.1  nisimura 	 */
    625       1.9       phx 	if (strncmp(s, "nfs:", 4) == 0 || strncmp(s, "net:", 4) == 0 ||
    626       1.9       phx 	    strncmp(s, "tftp:", 5) == 0 || strncmp(s, "mem:", 4) == 0)
    627       1.1  nisimura 		return 1;
    628       1.1  nisimura 	if (s[0] == 'w' && s[1] == 'd') {
    629       1.1  nisimura 		s += 2;
    630       1.1  nisimura 		if (*s != ':' && *s >= '0' && *s <= '3') {
    631       1.1  nisimura 			++s;
    632       1.1  nisimura 			if (*s != ':' && *s >= 'a' && *s <= 'p')
    633       1.1  nisimura 				++s;
    634       1.1  nisimura 		}
    635       1.1  nisimura 		return *s == ':';
    636       1.1  nisimura 	}
    637       1.1  nisimura 	return 0;
    638       1.1  nisimura }
    639       1.7       phx 
    640      1.11       phx static int input_cmdline(char **argv, int maxargc)
    641      1.11       phx {
    642      1.11       phx 	char *cmdline;
    643      1.11       phx 
    644      1.11       phx 	printf("\nbootargs> ");
    645      1.11       phx 	cmdline = alloc(256);
    646  1.21.2.3  jdolecek 	kgets(cmdline, 256);
    647      1.11       phx 
    648      1.11       phx 	return parse_cmdline(argv, maxargc, cmdline,
    649      1.11       phx 	    cmdline + strlen(cmdline));
    650      1.11       phx }
    651      1.11       phx 
    652       1.7       phx static int
    653       1.7       phx parse_cmdline(char **argv, int maxargc, char *p, char *end)
    654       1.7       phx {
    655       1.7       phx 	int argc;
    656       1.7       phx 
    657       1.7       phx 	argv[0] = "";
    658       1.7       phx 	for (argc = 1; argc < maxargc && p < end; argc++) {
    659       1.7       phx 		while (is_space(*p))
    660       1.7       phx 			p++;
    661       1.7       phx 		if (p >= end)
    662       1.7       phx 			break;
    663       1.7       phx 		argv[argc] = p;
    664       1.7       phx 		while (!is_space(*p) && p < end)
    665       1.7       phx 			p++;
    666       1.7       phx 		*p++ = '\0';
    667       1.7       phx 	}
    668       1.7       phx 
    669       1.7       phx 	return argc;
    670       1.7       phx }
    671       1.7       phx 
    672       1.7       phx static int
    673       1.7       phx is_space(char c)
    674       1.7       phx {
    675      1.15       phx 
    676       1.7       phx 	return c > '\0' && c <= ' ';
    677       1.7       phx }
    678      1.15       phx 
    679      1.15       phx #ifdef DEBUG
    680      1.15       phx static void
    681  1.21.2.1       tls findflash(void)
    682  1.21.2.1       tls {
    683  1.21.2.1       tls 	char buf[256];
    684  1.21.2.1       tls 	int i, n;
    685  1.21.2.1       tls 	unsigned char c, *p;
    686  1.21.2.1       tls 
    687  1.21.2.1       tls 	for (;;) {
    688  1.21.2.1       tls 		printf("\nfind> ");
    689  1.21.2.3  jdolecek 		kgets(buf, sizeof(buf));
    690  1.21.2.1       tls 		if (tolower((unsigned)buf[0]) == 'x')
    691  1.21.2.1       tls 			break;
    692  1.21.2.1       tls 		for (i = 0, n = 0, c = 0; buf[i]; i++) {
    693  1.21.2.1       tls 			c <<= 4;
    694  1.21.2.1       tls 			c |= hex2nibble(buf[i]);
    695  1.21.2.1       tls 			if (i & 1)
    696  1.21.2.1       tls 				buf[n++] = c;
    697  1.21.2.1       tls 		}
    698  1.21.2.1       tls 		printf("Searching for:");
    699  1.21.2.1       tls 		for (i = 0; i < n; i++)
    700  1.21.2.1       tls 			printf(" %02x", buf[i]);
    701  1.21.2.1       tls 		printf("\n");
    702  1.21.2.1       tls 		for (p = (unsigned char *)0xff000000;
    703  1.21.2.1       tls 		     p <= (unsigned char *)(0xffffffff-n); p++) {
    704  1.21.2.1       tls 			for (i = 0; i < n; i++) {
    705  1.21.2.1       tls 				if (p[i] != buf[i])
    706  1.21.2.1       tls 					break;
    707  1.21.2.1       tls 			}
    708  1.21.2.1       tls 			if (i >= n)
    709  1.21.2.1       tls 				printf("Found at %08x\n", (unsigned)p);
    710  1.21.2.1       tls 		}
    711  1.21.2.1       tls 	}
    712  1.21.2.1       tls }
    713  1.21.2.1       tls 
    714  1.21.2.1       tls static void
    715      1.15       phx sat_test(void)
    716      1.15       phx {
    717      1.15       phx 	char buf[1024];
    718      1.15       phx 	int i, j, n, pos;
    719      1.15       phx 	unsigned char c;
    720      1.15       phx 
    721      1.15       phx 	putchar('\n');
    722      1.15       phx 	for (;;) {
    723      1.15       phx 		do {
    724      1.15       phx 			for (pos = 0; pos < 1024 && sat_tstch() != 0; pos++)
    725      1.15       phx 				buf[pos] = sat_getch();
    726      1.15       phx 			if (pos > 1023)
    727      1.15       phx 				break;
    728      1.15       phx 			delay(100000);
    729      1.15       phx 		} while (sat_tstch());
    730      1.15       phx 
    731      1.15       phx 		for (i = 0; i < pos; i += 16) {
    732      1.15       phx 			if ((n = i + 16) > pos)
    733      1.15       phx 				n = pos;
    734      1.15       phx 			for (j = 0; j < n; j++)
    735      1.15       phx 				printf("%02x ", (unsigned)buf[i + j]);
    736      1.15       phx 			for (; j < 16; j++)
    737      1.15       phx 				printf("   ");
    738      1.15       phx 			putchar('\"');
    739      1.15       phx 			for (j = 0; j < n; j++) {
    740      1.15       phx 				c = buf[i + j];
    741      1.15       phx 				putchar((c >= 0x20 && c <= 0x7e) ? c : '.');
    742      1.15       phx 			}
    743      1.15       phx 			printf("\"\n");
    744      1.15       phx 		}
    745      1.15       phx 
    746      1.15       phx 		printf("controller> ");
    747  1.21.2.3  jdolecek 		kgets(buf, sizeof(buf));
    748      1.15       phx 		if (buf[0] == '*' && buf[1] == 'X')
    749      1.15       phx 			break;
    750      1.15       phx 
    751      1.15       phx 		if (buf[0] == '0' && tolower((unsigned)buf[1]) == 'x') {
    752      1.15       phx 			for (i = 2, n = 0, c = 0; buf[i]; i++) {
    753      1.15       phx 				c <<= 4;
    754      1.15       phx 				c |= hex2nibble(buf[i]);
    755      1.15       phx 				if (i & 1)
    756      1.15       phx 					buf[n++] = c;
    757      1.15       phx 			}
    758      1.15       phx 		} else
    759      1.15       phx 			n = strlen(buf);
    760      1.15       phx 
    761      1.15       phx 		if (n > 0)
    762      1.15       phx 			sat_write(buf, n);
    763      1.15       phx 	}
    764      1.15       phx }
    765      1.15       phx #endif
    766