Home | History | Annotate | Line # | Download | only in boot
init_main.c revision 1.8
      1  1.8  tsutsui /*	$NetBSD: init_main.c,v 1.8 2014/01/05 06:56:22 tsutsui Exp $	*/
      2  1.1  tsutsui 
      3  1.1  tsutsui /*
      4  1.1  tsutsui  * Copyright (c) 1992 OMRON Corporation.
      5  1.1  tsutsui  *
      6  1.1  tsutsui  * This code is derived from software contributed to Berkeley by
      7  1.1  tsutsui  * OMRON Corporation.
      8  1.1  tsutsui  *
      9  1.1  tsutsui  * Redistribution and use in source and binary forms, with or without
     10  1.1  tsutsui  * modification, are permitted provided that the following conditions
     11  1.1  tsutsui  * are met:
     12  1.1  tsutsui  * 1. Redistributions of source code must retain the above copyright
     13  1.1  tsutsui  *    notice, this list of conditions and the following disclaimer.
     14  1.1  tsutsui  * 2. Redistributions in binary form must reproduce the above copyright
     15  1.1  tsutsui  *    notice, this list of conditions and the following disclaimer in the
     16  1.1  tsutsui  *    documentation and/or other materials provided with the distribution.
     17  1.1  tsutsui  * 3. All advertising materials mentioning features or use of this software
     18  1.1  tsutsui  *    must display the following acknowledgement:
     19  1.1  tsutsui  *	This product includes software developed by the University of
     20  1.1  tsutsui  *	California, Berkeley and its contributors.
     21  1.1  tsutsui  * 4. Neither the name of the University nor the names of its contributors
     22  1.1  tsutsui  *    may be used to endorse or promote products derived from this software
     23  1.1  tsutsui  *    without specific prior written permission.
     24  1.1  tsutsui  *
     25  1.1  tsutsui  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     26  1.1  tsutsui  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     27  1.1  tsutsui  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     28  1.1  tsutsui  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     29  1.1  tsutsui  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     30  1.1  tsutsui  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     31  1.1  tsutsui  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     32  1.1  tsutsui  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     33  1.1  tsutsui  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     34  1.1  tsutsui  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     35  1.1  tsutsui  * SUCH DAMAGE.
     36  1.1  tsutsui  *
     37  1.1  tsutsui  *	@(#)init_main.c	8.2 (Berkeley) 8/15/93
     38  1.1  tsutsui  */
     39  1.1  tsutsui /*
     40  1.1  tsutsui  * Copyright (c) 1992, 1993
     41  1.1  tsutsui  *	The Regents of the University of California.  All rights reserved.
     42  1.1  tsutsui  *
     43  1.1  tsutsui  * This code is derived from software contributed to Berkeley by
     44  1.1  tsutsui  * OMRON Corporation.
     45  1.1  tsutsui  *
     46  1.1  tsutsui  * Redistribution and use in source and binary forms, with or without
     47  1.1  tsutsui  * modification, are permitted provided that the following conditions
     48  1.1  tsutsui  * are met:
     49  1.1  tsutsui  * 1. Redistributions of source code must retain the above copyright
     50  1.1  tsutsui  *    notice, this list of conditions and the following disclaimer.
     51  1.1  tsutsui  * 2. Redistributions in binary form must reproduce the above copyright
     52  1.1  tsutsui  *    notice, this list of conditions and the following disclaimer in the
     53  1.1  tsutsui  *    documentation and/or other materials provided with the distribution.
     54  1.1  tsutsui  * 3. Neither the name of the University nor the names of its contributors
     55  1.1  tsutsui  *    may be used to endorse or promote products derived from this software
     56  1.1  tsutsui  *    without specific prior written permission.
     57  1.1  tsutsui  *
     58  1.1  tsutsui  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     59  1.1  tsutsui  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     60  1.1  tsutsui  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     61  1.1  tsutsui  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     62  1.1  tsutsui  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     63  1.1  tsutsui  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     64  1.1  tsutsui  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     65  1.1  tsutsui  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     66  1.1  tsutsui  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     67  1.1  tsutsui  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     68  1.1  tsutsui  * SUCH DAMAGE.
     69  1.1  tsutsui  *
     70  1.1  tsutsui  *	@(#)init_main.c	8.2 (Berkeley) 8/15/93
     71  1.1  tsutsui  */
     72  1.1  tsutsui 
     73  1.1  tsutsui #include <sys/param.h>
     74  1.6  tsutsui #include <sys/boot_flag.h>
     75  1.1  tsutsui #include <machine/cpu.h>
     76  1.1  tsutsui #include <luna68k/stand/boot/samachdep.h>
     77  1.1  tsutsui #include <luna68k/stand/boot/stinger.h>
     78  1.1  tsutsui #include <luna68k/stand/boot/romvec.h>
     79  1.1  tsutsui #include <luna68k/stand/boot/status.h>
     80  1.1  tsutsui #include <lib/libsa/loadfile.h>
     81  1.3  tsutsui #ifdef SUPPORT_ETHERNET
     82  1.3  tsutsui #include <lib/libsa/dev_net.h>
     83  1.3  tsutsui #endif
     84  1.1  tsutsui 
     85  1.1  tsutsui static int get_plane_numbers(void);
     86  1.1  tsutsui static int reorder_dipsw(int);
     87  1.1  tsutsui 
     88  1.2  tsutsui int cpuspeed;	/* for DELAY() macro */
     89  1.5  tsutsui int hz = 60;
     90  1.2  tsutsui int machtype;
     91  1.6  tsutsui char default_file[64];
     92  1.1  tsutsui 
     93  1.1  tsutsui #define	VERS_LOCAL	"Phase-31"
     94  1.1  tsutsui 
     95  1.1  tsutsui int nplane;
     96  1.1  tsutsui 
     97  1.1  tsutsui /* KIFF */
     98  1.1  tsutsui 
     99  1.1  tsutsui struct KernInter  KIFF;
    100  1.1  tsutsui struct KernInter *kiff = &KIFF;
    101  1.1  tsutsui 
    102  1.1  tsutsui /* for command parser */
    103  1.1  tsutsui 
    104  1.1  tsutsui #define BUFFSIZE 100
    105  1.1  tsutsui #define MAXARGS  30
    106  1.1  tsutsui 
    107  1.1  tsutsui char buffer[BUFFSIZE];
    108  1.1  tsutsui 
    109  1.1  tsutsui int   argc;
    110  1.1  tsutsui char *argv[MAXARGS];
    111  1.1  tsutsui 
    112  1.5  tsutsui #define BOOT_TIMEOUT 10
    113  1.5  tsutsui int boot_timeout = BOOT_TIMEOUT;
    114  1.5  tsutsui 
    115  1.7  tsutsui static const char prompt[] = "boot> ";
    116  1.1  tsutsui 
    117  1.8  tsutsui /*
    118  1.8  tsutsui  * PROM monitor's boot device info
    119  1.8  tsutsui  */
    120  1.8  tsutsui 
    121  1.8  tsutsui /* LUNA-I monitor's bootinfo structure */
    122  1.8  tsutsui /* This bootinfo data address is investigated on ROM Ver4.22 and Ver4.25 */
    123  1.8  tsutsui #define	LUNA1_BOOTINFOADDR	0x000008c0
    124  1.8  tsutsui struct luna1_bootinfo {
    125  1.8  tsutsui 	uint8_t	bi_xxx1[3];	/* 0x08c0: ??? */
    126  1.8  tsutsui 	uint8_t	bi_device;	/* 0x08c3: boot device */
    127  1.8  tsutsui #define	LUNA1_BTDEV_DK	0		/* Hard-Disk */
    128  1.8  tsutsui #define	LUNA1_BTDEV_FB	1		/* Floppy-Disk */
    129  1.8  tsutsui #define	LUNA1_BTDEV_SD	2		/* Streamer-Tape */
    130  1.8  tsutsui #define	LUNA1_BTDEV_P0	3		/* RS232c */
    131  1.8  tsutsui #define	LUNA1_BTDEV_ET	4		/* Ether-net */
    132  1.8  tsutsui #define	LUNA1_NBTDEV	5
    133  1.8  tsutsui 
    134  1.8  tsutsui 	struct {
    135  1.8  tsutsui 		uint8_t	bd_xxx1;	/*  0: ??? */
    136  1.8  tsutsui 		uint8_t	bd_boot;	/*  1: 1 == booted */
    137  1.8  tsutsui 		char	bd_name[2];	/*  2: device name (dk, fb, sd ... ) */
    138  1.8  tsutsui 		uint8_t	bd_unit;	/*  4: unit number (not ID) */
    139  1.8  tsutsui 		uint8_t	bd_xxx2;	/*  5: ??? */
    140  1.8  tsutsui 		uint8_t	bd_xxx3;	/*  6: ??? */
    141  1.8  tsutsui 		uint8_t	bd_part;	/*  7: dk partition / st record # */
    142  1.8  tsutsui 		uint8_t	bd_xxx4[4];	/*  8: ??? */
    143  1.8  tsutsui 		uint8_t	bd_xxx5[4];	/* 12: ??? */
    144  1.8  tsutsui 	} bi_devinfo[LUNA1_NBTDEV];
    145  1.8  tsutsui } __packed;
    146  1.8  tsutsui 
    147  1.8  tsutsui /* LUNA-II monitor's bootinfo structure */
    148  1.8  tsutsui /* This bootinfo data address is investigated on ROM Version 1.11 */
    149  1.8  tsutsui #define	LUNA2_BOOTINFOADDR	0x00001d80
    150  1.8  tsutsui struct luna2_bootinfo {
    151  1.8  tsutsui 	uint8_t	bi_xxx1[13];	/* 0x1d80: ??? */
    152  1.8  tsutsui 	uint8_t	bi_device;	/* 0x1d8d: boot device */
    153  1.8  tsutsui #define	LUNA2_BTDEV_DK	0		/* Hard-Disk */
    154  1.8  tsutsui #define	LUNA2_BTDEV_FT	1		/* Floppy-Disk */
    155  1.8  tsutsui #define	LUNA2_BTDEV_SD	2		/* Streamer-Tape */
    156  1.8  tsutsui #define	LUNA2_BTDEV_P0	3		/* RS232c */
    157  1.8  tsutsui #define	LUNA2_NBTDEV	4
    158  1.8  tsutsui 
    159  1.8  tsutsui 	struct {
    160  1.8  tsutsui 		uint8_t	bd_xxx1;	/*  0: ??? */
    161  1.8  tsutsui 		uint8_t	bd_boot;	/*  1: 1 == booted */
    162  1.8  tsutsui 		char	bd_name[4];	/*  2: device name (dk, ft, sd ... ) */
    163  1.8  tsutsui 		uint8_t	bd_xxx2;	/*  6: ??? */
    164  1.8  tsutsui 		uint8_t	bd_ctlr;	/*  7: SCSI controller number */
    165  1.8  tsutsui 		uint8_t	bd_unit;	/*  8: SCSI ID number */
    166  1.8  tsutsui 		uint8_t	bd_xxx3;	/*  9: device number index? */
    167  1.8  tsutsui 		uint8_t	bd_xxx4;	/* 10: ??? */
    168  1.8  tsutsui 		uint8_t	bd_part;	/* 11: dk partition / st record # */
    169  1.8  tsutsui 		uint8_t	bd_xxx5[4];	/* 12: ??? */
    170  1.8  tsutsui 		uint8_t	bd_xxx6[4];	/* 16: ??? */
    171  1.8  tsutsui 	} bi_devinfo[LUNA2_NBTDEV];
    172  1.8  tsutsui } __packed;
    173  1.8  tsutsui 
    174  1.8  tsutsui /* #define BTINFO_DEBUG */
    175  1.8  tsutsui 
    176  1.1  tsutsui void
    177  1.1  tsutsui main(void)
    178  1.1  tsutsui {
    179  1.1  tsutsui 	int i, status = 0;
    180  1.2  tsutsui 	const char *machstr;
    181  1.8  tsutsui 	const char *bootdev;
    182  1.6  tsutsui 	int unit, part;
    183  1.1  tsutsui 
    184  1.1  tsutsui 	/*
    185  1.1  tsutsui 	 * Initialize the console before we print anything out.
    186  1.1  tsutsui 	 */
    187  1.2  tsutsui 	if (cputype == CPU_68030) {
    188  1.2  tsutsui 		machtype = LUNA_I;
    189  1.2  tsutsui 		machstr  = "LUNA-I";
    190  1.2  tsutsui 		cpuspeed = MHZ_25;
    191  1.5  tsutsui 		hz = 60;
    192  1.2  tsutsui 	} else {
    193  1.2  tsutsui 		machtype = LUNA_II;
    194  1.2  tsutsui 		machstr  = "LUNA-II";
    195  1.2  tsutsui 		cpuspeed = MHZ_25 * 2;	/* XXX */
    196  1.5  tsutsui 		hz = 100;
    197  1.2  tsutsui 	}
    198  1.1  tsutsui 
    199  1.1  tsutsui 	nplane   = get_plane_numbers();
    200  1.1  tsutsui 
    201  1.1  tsutsui 	cninit();
    202  1.1  tsutsui 
    203  1.1  tsutsui 	printf("\n");
    204  1.1  tsutsui 	printf(">> %s, Revision %s\n", bootprog_name, bootprog_rev);
    205  1.1  tsutsui 	printf(">> (based on Stinger ver 0.0 [%s])\n", VERS_LOCAL);
    206  1.1  tsutsui 	printf("\n");
    207  1.1  tsutsui 
    208  1.1  tsutsui 	kiff->maxaddr = (void *) (ROM_memsize -1);
    209  1.1  tsutsui 	kiff->dipsw   = ~((dipsw2 << 8) | dipsw1) & 0xFFFF;
    210  1.1  tsutsui 	kiff->plane   = nplane;
    211  1.1  tsutsui 
    212  1.1  tsutsui 	i = (int) kiff->maxaddr + 1;
    213  1.2  tsutsui 	printf("Machine model   = %s\n", machstr);
    214  1.1  tsutsui 	printf("Physical Memory = 0x%x  ", i);
    215  1.1  tsutsui 	i >>= 20;
    216  1.1  tsutsui 	printf("(%d MB)\n", i);
    217  1.1  tsutsui 	printf("\n");
    218  1.1  tsutsui 
    219  1.1  tsutsui 	/*
    220  1.1  tsutsui 	 * IO configuration
    221  1.1  tsutsui 	 */
    222  1.1  tsutsui 
    223  1.3  tsutsui #ifdef SUPPORT_ETHERNET
    224  1.3  tsutsui 	try_bootp = 1;
    225  1.3  tsutsui #endif
    226  1.3  tsutsui 
    227  1.1  tsutsui 	find_devs();
    228  1.1  tsutsui 	configure();
    229  1.1  tsutsui 	printf("\n");
    230  1.1  tsutsui 
    231  1.8  tsutsui 	/* use sd(0,0) for the default boot device */
    232  1.8  tsutsui 	bootdev = "sd";
    233  1.8  tsutsui 	unit = 0;
    234  1.6  tsutsui 	part = 0;
    235  1.8  tsutsui 
    236  1.8  tsutsui 	if (machtype == LUNA_I) {
    237  1.8  tsutsui 		const struct luna1_bootinfo *bi1 = (void *)LUNA1_BOOTINFOADDR;
    238  1.8  tsutsui 		int dev = bi1->bi_device;
    239  1.8  tsutsui 
    240  1.8  tsutsui 		switch (dev) {
    241  1.8  tsutsui 		case LUNA1_BTDEV_DK:
    242  1.8  tsutsui 			/* XXX: should check hp_dinfo in ioconf.c */
    243  1.8  tsutsui 			/* note: bd_unit is not SCSI ID */
    244  1.8  tsutsui 			unit = bi1->bi_devinfo[dev].bd_unit;
    245  1.8  tsutsui 			break;
    246  1.8  tsutsui 		case LUNA1_BTDEV_ET:
    247  1.8  tsutsui 			bootdev = "le";
    248  1.8  tsutsui 			unit = 0;
    249  1.8  tsutsui 			break;
    250  1.8  tsutsui 		default:
    251  1.8  tsutsui 			/* not supported */
    252  1.8  tsutsui 			break;
    253  1.8  tsutsui 		}
    254  1.8  tsutsui #ifdef BTINFO_DEBUG
    255  1.8  tsutsui 		printf("bi1->bi_device = 0x%02x\n", bi1->bi_device);
    256  1.8  tsutsui 		printf("bi1->bi_devinfo[dev].bd_boot = 0x%02x\n",
    257  1.8  tsutsui 		    bi1->bi_devinfo[dev].bd_boot);
    258  1.8  tsutsui 		printf("bi1->bi_devinfo[dev].bd_name = %c%c\n",
    259  1.8  tsutsui 		    bi1->bi_devinfo[dev].bd_name[0],
    260  1.8  tsutsui 		    bi1->bi_devinfo[dev].bd_name[1]);
    261  1.8  tsutsui 		printf("bi1->bi_devinfo[dev].bd_unit = 0x%02x\n",
    262  1.8  tsutsui 		    bi1->bi_devinfo[dev].bd_unit);
    263  1.8  tsutsui 		printf("bi1->bi_devinfo[dev].bd_part = 0x%02x\n",
    264  1.8  tsutsui 		    bi1->bi_devinfo[dev].bd_part);
    265  1.8  tsutsui #endif
    266  1.8  tsutsui 	} else {
    267  1.8  tsutsui 		const struct luna2_bootinfo *bi2 = (void *)LUNA2_BOOTINFOADDR;
    268  1.8  tsutsui 		int dev = bi2->bi_device;
    269  1.8  tsutsui 		int ctlr, id;
    270  1.8  tsutsui 
    271  1.8  tsutsui 		switch (dev) {
    272  1.8  tsutsui 		case LUNA2_BTDEV_DK:
    273  1.8  tsutsui 			ctlr = bi2->bi_devinfo[dev].bd_ctlr;
    274  1.8  tsutsui 			id = bi2->bi_devinfo[dev].bd_unit;
    275  1.8  tsutsui 			/* XXX: should check hp_dinfo in ioconf.c */
    276  1.8  tsutsui 			unit = 6 - id;
    277  1.8  tsutsui 			if (ctlr == 1) {
    278  1.8  tsutsui 				/* XXX: should check hp_dinfo in ioconf.c */
    279  1.8  tsutsui 				unit += 2;
    280  1.8  tsutsui 			}
    281  1.8  tsutsui 			break;
    282  1.8  tsutsui 		default:
    283  1.8  tsutsui 			/* not supported */
    284  1.8  tsutsui 			break;
    285  1.8  tsutsui 		}
    286  1.8  tsutsui #ifdef BTINFO_DEBUG
    287  1.8  tsutsui 		printf("bi2->bi_device = 0x%02x\n", bi2->bi_device);
    288  1.8  tsutsui 		printf("bi2->bi_devinfo[dev].bd_boot = 0x%02x\n",
    289  1.8  tsutsui 		    bi2->bi_devinfo[dev].bd_boot);
    290  1.8  tsutsui 		printf("bi2->bi_devinfo[dev].bd_name = %s\n",
    291  1.8  tsutsui 		    bi2->bi_devinfo[dev].bd_name);
    292  1.8  tsutsui 		printf("bi2->bi_devinfo[dev].bd_ctlr = 0x%02x\n",
    293  1.8  tsutsui 		    bi2->bi_devinfo[dev].bd_ctlr);
    294  1.8  tsutsui 		printf("bi2->bi_devinfo[dev].bd_unit = 0x%02x\n",
    295  1.8  tsutsui 		    bi2->bi_devinfo[dev].bd_unit);
    296  1.8  tsutsui 		printf("bi2->bi_devinfo[dev].bd_part = 0x%02x\n",
    297  1.8  tsutsui 		    bi2->bi_devinfo[dev].bd_part);
    298  1.8  tsutsui #endif
    299  1.8  tsutsui 	}
    300  1.8  tsutsui 
    301  1.6  tsutsui 	snprintf(default_file, sizeof(default_file),
    302  1.8  tsutsui 	    "%s(%d,%d)%s", bootdev, unit, part, "netbsd");
    303  1.6  tsutsui 
    304  1.1  tsutsui 	howto = reorder_dipsw(dipsw2);
    305  1.1  tsutsui 
    306  1.1  tsutsui 	if ((howto & 0xFE) == 0) {
    307  1.5  tsutsui 		char c;
    308  1.5  tsutsui 
    309  1.5  tsutsui 		printf("Press return to boot now,"
    310  1.5  tsutsui 		    " any other key for boot menu\n");
    311  1.5  tsutsui 		printf("booting %s - starting in ", default_file);
    312  1.5  tsutsui 		c = awaitkey("%d seconds. ", boot_timeout, true);
    313  1.5  tsutsui 		if (c == '\r' || c == '\n' || c == 0) {
    314  1.5  tsutsui 			printf("auto-boot %s\n", default_file);
    315  1.5  tsutsui 			bootnetbsd(default_file);
    316  1.5  tsutsui 		}
    317  1.1  tsutsui 	}
    318  1.1  tsutsui 
    319  1.1  tsutsui 	/*
    320  1.1  tsutsui 	 * Main Loop
    321  1.1  tsutsui 	 */
    322  1.1  tsutsui 
    323  1.5  tsutsui 	printf("type \"help\" for help.\n");
    324  1.5  tsutsui 
    325  1.1  tsutsui 	do {
    326  1.1  tsutsui 		memset(buffer, 0, BUFFSIZE);
    327  1.1  tsutsui 		if (getline(prompt, buffer) > 0) {
    328  1.1  tsutsui 			argc = getargs(buffer, argv, sizeof(argv)/sizeof(char *));
    329  1.1  tsutsui 
    330  1.1  tsutsui 			status = parse(argc, argv);
    331  1.1  tsutsui 			if (status == ST_NOTFOUND)
    332  1.1  tsutsui 				printf("Command \"%s\" is not found !!\n", argv[0]);
    333  1.1  tsutsui 		}
    334  1.1  tsutsui 	} while(status != ST_EXIT);
    335  1.1  tsutsui 
    336  1.1  tsutsui 	exit(0);
    337  1.1  tsutsui }
    338  1.1  tsutsui 
    339  1.1  tsutsui int
    340  1.1  tsutsui get_plane_numbers(void)
    341  1.1  tsutsui {
    342  1.1  tsutsui 	int r = ROM_plane;
    343  1.1  tsutsui 	int n = 0;
    344  1.1  tsutsui 
    345  1.1  tsutsui 	for (; r ; r >>= 1)
    346  1.1  tsutsui 		if (r & 0x1)
    347  1.1  tsutsui 			n++;
    348  1.1  tsutsui 
    349  1.1  tsutsui 	return(n);
    350  1.1  tsutsui }
    351  1.1  tsutsui 
    352  1.1  tsutsui int
    353  1.1  tsutsui reorder_dipsw(int dipsw)
    354  1.1  tsutsui {
    355  1.1  tsutsui 	int i, sw = 0;
    356  1.1  tsutsui 
    357  1.1  tsutsui 	for (i = 0; i < 8; i++) {
    358  1.1  tsutsui 		if ((dipsw & 0x01) == 0)
    359  1.1  tsutsui 			sw += 1;
    360  1.1  tsutsui 
    361  1.1  tsutsui 		if (i == 7)
    362  1.1  tsutsui 			break;
    363  1.1  tsutsui 
    364  1.1  tsutsui 		sw <<= 1;
    365  1.1  tsutsui 		dipsw >>= 1;
    366  1.1  tsutsui 	}
    367  1.1  tsutsui 
    368  1.1  tsutsui 	return(sw);
    369  1.1  tsutsui }
    370