Home | History | Annotate | Line # | Download | only in mboot
mboot.c revision 1.5.76.1
      1  1.5.76.1     yamt /*	$NetBSD: mboot.c,v 1.5.76.1 2008/05/18 12:33:01 yamt Exp $	*/
      2       1.1  minoura 
      3       1.1  minoura /*-
      4       1.1  minoura  * Copyright (c) 1999 The NetBSD Foundation, Inc.
      5       1.1  minoura  * All rights reserved.
      6       1.1  minoura  *
      7       1.1  minoura  * This code is derived from software contributed to The NetBSD Foundation
      8       1.1  minoura  * by Minoura Makoto.
      9       1.1  minoura  *
     10       1.1  minoura  * Redistribution and use in source and binary forms, with or without
     11       1.1  minoura  * modification, are permitted provided that the following conditions
     12       1.1  minoura  * are met:
     13       1.1  minoura  * 1. Redistributions of source code must retain the above copyright
     14       1.1  minoura  *    notice, this list of conditions and the following disclaimer.
     15       1.1  minoura  * 2. Redistributions in binary form must reproduce the above copyright
     16       1.1  minoura  *    notice, this list of conditions and the following disclaimer in the
     17       1.1  minoura  *    documentation and/or other materials provided with the distribution.
     18       1.1  minoura  *
     19       1.1  minoura  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20       1.1  minoura  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21       1.1  minoura  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22       1.1  minoura  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23       1.1  minoura  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24       1.1  minoura  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25       1.1  minoura  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26       1.1  minoura  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27       1.1  minoura  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28       1.1  minoura  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29       1.1  minoura  * POSSIBILITY OF SUCH DAMAGE.
     30       1.1  minoura  */
     31       1.1  minoura 
     32       1.1  minoura #include <sys/types.h>
     33       1.1  minoura #include <machine/disklabel.h>
     34       1.1  minoura 
     35       1.1  minoura struct iocs_readcap {
     36       1.1  minoura 	unsigned long	block;
     37       1.1  minoura 	unsigned long	size;
     38       1.1  minoura };
     39       1.1  minoura static inline int
     40       1.1  minoura IOCS_BITSNS (int row)
     41       1.1  minoura {
     42       1.3  minoura 	register unsigned int reg_d0 __asm ("%d0");
     43       1.1  minoura 
     44       1.4    perry 	__asm volatile ("movel %1,%%d1\n\t"
     45       1.1  minoura 			  "movel #0x04,%0\n\t"
     46       1.1  minoura 			  "trap #15"
     47       1.1  minoura 			  : "=d" (reg_d0)
     48       1.1  minoura 			  : "ri" ((int) row)
     49       1.3  minoura 			  : "%d1");
     50       1.1  minoura 
     51       1.1  minoura 	return reg_d0;
     52       1.1  minoura }
     53       1.1  minoura static inline void
     54       1.1  minoura IOCS_B_PRINT (const char *str)
     55       1.1  minoura {
     56       1.4    perry 	__asm volatile ("moval %0,%%a1\n\t"
     57       1.3  minoura 			  "movel #0x21,%%d0\n\t"
     58       1.1  minoura 			  "trap #15\n\t"
     59       1.1  minoura 			  :
     60       1.1  minoura 			  : "a" ((int) str)
     61       1.3  minoura 			  : "%a1", "%d0");
     62       1.1  minoura 	return;
     63       1.1  minoura }
     64       1.1  minoura static inline int
     65       1.1  minoura IOCS_S_READCAP (int id, struct iocs_readcap *cap)
     66       1.1  minoura {
     67       1.3  minoura 	register int reg_d0 __asm ("%d0");
     68       1.1  minoura 
     69       1.4    perry 	__asm volatile ("moveml %%d4,%%sp@-\n\t"
     70       1.3  minoura 			  "movel %2,%%d4\n\t"
     71       1.3  minoura 			  "moval %3,%%a1\n\t"
     72       1.3  minoura 			  "movel #0x25,%%d1\n\t"
     73       1.3  minoura 			  "movel #0xf5,%%d0\n\t"
     74       1.1  minoura 			  "trap #15\n\t"
     75       1.3  minoura 			  "moveml %%sp@+,%%d4"
     76       1.1  minoura 			  : "=d" (reg_d0), "=m" (*cap)
     77       1.1  minoura 			  : "ri" (id), "g" ((int) cap)
     78       1.3  minoura 			  : "%d1", "%a1");
     79       1.1  minoura 
     80       1.1  minoura 	return reg_d0;
     81       1.1  minoura }
     82       1.1  minoura static inline int
     83       1.2  minoura IOCS_S_READ (int pos, int blk, int id, int size, void *buf)
     84       1.2  minoura {
     85       1.3  minoura 	register int reg_d0 __asm ("%d0");
     86       1.2  minoura 
     87       1.4    perry 	__asm volatile ("moveml %%d3-%%d5,%%sp@-\n\t"
     88       1.3  minoura 			  "movel %2,%%d2\n\t"
     89       1.3  minoura 			  "movel %3,%%d3\n\t"
     90       1.3  minoura 			  "movel %4,%%d4\n\t"
     91       1.3  minoura 			  "movel %5,%%d5\n\t"
     92       1.3  minoura 			  "moval %6,%%a1\n\t"
     93       1.3  minoura 			  "movel #0x26,%%d1\n\t"
     94       1.3  minoura 			  "movel #0xf5,%%d0\n\t"
     95       1.2  minoura 			  "trap #15\n\t"
     96       1.3  minoura 			  "moveml %%sp@+,%%d3-%%d5"
     97       1.2  minoura 			  : "=d" (reg_d0), "=m" (*(char*) buf)
     98       1.2  minoura 			  : "ri" (pos), "ri" (blk), "ri" (id), "ri" (size), "g" ((int) buf)
     99       1.3  minoura 			  : "%d1", "%d2", "%a1");
    100       1.2  minoura 
    101       1.2  minoura 	return reg_d0;
    102       1.2  minoura }
    103       1.2  minoura 
    104       1.2  minoura static inline int
    105       1.1  minoura IOCS_S_READEXT (int pos, int blk, int id, int size, void *buf)
    106       1.1  minoura {
    107       1.3  minoura 	register int reg_d0 __asm ("%d0");
    108       1.1  minoura 
    109       1.4    perry 	__asm volatile ("moveml %%d3-%%d5,%%sp@-\n\t"
    110       1.3  minoura 			  "movel %2,%%d2\n\t"
    111       1.3  minoura 			  "movel %3,%%d3\n\t"
    112       1.3  minoura 			  "movel %4,%%d4\n\t"
    113       1.3  minoura 			  "movel %5,%%d5\n\t"
    114       1.3  minoura 			  "moval %6,%%a1\n\t"
    115       1.3  minoura 			  "movel #0x26,%%d1\n\t"
    116       1.3  minoura 			  "movel #0xf5,%%d0\n\t"
    117       1.1  minoura 			  "trap #15\n\t"
    118       1.3  minoura 			  "moveml %%sp@+,%%d3-%%d5"
    119       1.1  minoura 			  : "=d" (reg_d0), "=m" (*(char*) buf)
    120       1.1  minoura 			  : "ri" (pos), "ri" (blk), "ri" (id), "ri" (size), "g" ((int) buf)
    121       1.3  minoura 			  : "%d1", "%d2", "%a1");
    122       1.1  minoura 
    123       1.1  minoura 	return reg_d0;
    124       1.1  minoura }
    125       1.1  minoura 
    126       1.1  minoura #define PART_BOOTABLE	0
    127       1.1  minoura #define PART_UNUSED	1
    128       1.1  minoura #define PART_INUSE	2
    129       1.1  minoura 
    130       1.1  minoura 
    131       1.1  minoura 
    132       1.1  minoura int
    133       1.1  minoura bootmain(scsiid)
    134       1.1  minoura 	int scsiid;
    135       1.1  minoura {
    136       1.1  minoura 	struct iocs_readcap cap;
    137       1.1  minoura 	int size;
    138       1.1  minoura 
    139       1.1  minoura 	if (IOCS_BITSNS(0) & 1)	/* ESC key */
    140       1.1  minoura 		return 0;
    141       1.1  minoura 
    142       1.1  minoura 	if (IOCS_S_READCAP(scsiid, &cap) < 0) {
    143       1.1  minoura 		IOCS_B_PRINT("Error in reading.\r\n");
    144       1.1  minoura 		return 0;
    145       1.1  minoura 	}
    146       1.1  minoura 	size = cap.size >> 9;
    147       1.1  minoura 
    148       1.1  minoura 	{
    149       1.1  minoura 		long *label = (void*) 0x3000;
    150       1.2  minoura 		if (IOCS_S_READ(0, 1, scsiid, size, label) < 0) {
    151       1.1  minoura 			IOCS_B_PRINT("Error in reading.\r\n");
    152       1.1  minoura 			return 0;
    153       1.1  minoura 		}
    154       1.1  minoura 		if (label[0] != 0x58363853 ||
    155       1.1  minoura 		    label[1] != 0x43534931) {
    156       1.1  minoura 			IOCS_B_PRINT("Invalid disk.\r\n");
    157       1.1  minoura 			return 0;
    158       1.1  minoura 		}
    159       1.1  minoura 	}
    160       1.1  minoura 
    161       1.1  minoura 	{
    162       1.1  minoura 		struct cpu_disklabel *label = (void*) 0x3000;
    163       1.1  minoura 		int i, firstinuse=-1;
    164       1.1  minoura 
    165       1.2  minoura 		if (IOCS_S_READ(2<<(2-size), size?2:1, scsiid, size, label) < 0) {
    166       1.1  minoura 			IOCS_B_PRINT("Error in reading.\r\n");
    167       1.1  minoura 			return 0;
    168       1.1  minoura 		}
    169       1.1  minoura 		if (*((long*) &label->dosparts[0].dp_typname) != 0x5836384b) {
    170       1.1  minoura 			IOCS_B_PRINT("Invalid disk.\r\n");
    171       1.1  minoura 			return 0;
    172       1.1  minoura 		}
    173       1.1  minoura 
    174       1.1  minoura 		for (i = 1; i < NDOSPART; i++) {
    175       1.1  minoura 			if (label->dosparts[i].dp_flag == PART_BOOTABLE)
    176       1.1  minoura 				break;
    177       1.1  minoura 			else if (label->dosparts[i].dp_flag == PART_INUSE)
    178       1.1  minoura 				firstinuse = i;
    179       1.1  minoura 		}
    180       1.1  minoura 		if (i >= NDOSPART && firstinuse >= 0)
    181       1.1  minoura 			i = firstinuse;
    182       1.1  minoura 		if (i < NDOSPART) {
    183       1.1  minoura 			unsigned int start = label->dosparts[i].dp_start;
    184       1.2  minoura 			unsigned int start1 = start << (2-size);
    185       1.2  minoura 			int r;
    186       1.2  minoura 			if ((start1 & 0x1fffff) == 0x1fffff)
    187       1.2  minoura 				r = IOCS_S_READ(start1,
    188       1.2  minoura 						8>>size,
    189       1.2  minoura 						scsiid,
    190       1.2  minoura 						size,
    191       1.2  minoura 						(void*) 0x2400);
    192       1.2  minoura 			else
    193       1.2  minoura 				r = IOCS_S_READEXT(start1,
    194       1.2  minoura 						   8>>size,
    195       1.2  minoura 						   scsiid,
    196       1.2  minoura 						   size,
    197       1.2  minoura 						   (void*) 0x2400);
    198       1.2  minoura 			if (r < 0) {
    199       1.1  minoura 				IOCS_B_PRINT ("Error in reading.\r\n");
    200       1.1  minoura 				return 0;
    201       1.1  minoura 			}
    202       1.1  minoura 			if (*((char*) 0x2400) != 0x60) {
    203       1.1  minoura 				IOCS_B_PRINT("Invalid disk.\r\n");
    204       1.1  minoura 				return 0;
    205       1.1  minoura 			}
    206       1.5    perry 			__asm volatile ("movl %0,%%d4\n\t"
    207       1.3  minoura 				      "movl %1,%%d2\n\t"
    208       1.1  minoura 				      "jsr 0x2400"
    209       1.1  minoura 				      :
    210       1.1  minoura 				      : "g" (scsiid), "g"(start)
    211       1.1  minoura 				      : "d4");
    212       1.1  minoura 			return 0;
    213       1.1  minoura 		}
    214       1.1  minoura 		IOCS_B_PRINT ("No bootable partition.\r\n");
    215       1.1  minoura 		return 0;
    216       1.1  minoura 	}
    217       1.1  minoura 
    218       1.1  minoura 	return 0;
    219       1.1  minoura }
    220