227 lines
5.8 KiB
C
227 lines
5.8 KiB
C
/* $NetBSD: mboot.c,v 1.2 2001/01/26 17:30:16 minoura Exp $ */
|
|
|
|
/*-
|
|
* Copyright (c) 1999 The NetBSD Foundation, Inc.
|
|
* All rights reserved.
|
|
*
|
|
* This code is derived from software contributed to The NetBSD Foundation
|
|
* by Minoura Makoto.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
* 3. All advertising materials mentioning features or use of this software
|
|
* must display the following acknowledgement:
|
|
* This product includes software developed by the NetBSD
|
|
* Foundation, Inc. and its contributors.
|
|
* 4. Neither the name of The NetBSD Foundation nor the names of its
|
|
* contributors may be used to endorse or promote products derived
|
|
* from this software without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
|
|
* ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
|
|
* TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
|
|
* PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
|
|
* BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
|
|
* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
|
|
* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
|
|
* INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
|
|
* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
|
|
* ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
|
* POSSIBILITY OF SUCH DAMAGE.
|
|
*/
|
|
|
|
#include <sys/types.h>
|
|
#include <machine/disklabel.h>
|
|
|
|
struct iocs_readcap {
|
|
unsigned long block;
|
|
unsigned long size;
|
|
};
|
|
static inline int
|
|
IOCS_BITSNS (int row)
|
|
{
|
|
register unsigned int reg_d0 __asm ("d0");
|
|
|
|
__asm __volatile ("movel %1,d1\n\t"
|
|
"movel #0x04,%0\n\t"
|
|
"trap #15"
|
|
: "=d" (reg_d0)
|
|
: "ri" ((int) row)
|
|
: "d1");
|
|
|
|
return reg_d0;
|
|
}
|
|
static inline void
|
|
IOCS_B_PRINT (const char *str)
|
|
{
|
|
__asm __volatile ("moval %0,a1\n\t"
|
|
"movel #0x21,d0\n\t"
|
|
"trap #15\n\t"
|
|
:
|
|
: "a" ((int) str)
|
|
: "a1", "d0");
|
|
return;
|
|
}
|
|
static inline int
|
|
IOCS_S_READCAP (int id, struct iocs_readcap *cap)
|
|
{
|
|
register int reg_d0 __asm ("d0");
|
|
|
|
__asm __volatile ("moveml d4,sp@-\n\t"
|
|
"movel %2,d4\n\t"
|
|
"moval %3,a1\n\t"
|
|
"movel #0x25,d1\n\t"
|
|
"movel #0xf5,d0\n\t"
|
|
"trap #15\n\t"
|
|
"moveml sp@+,d4"
|
|
: "=d" (reg_d0), "=m" (*cap)
|
|
: "ri" (id), "g" ((int) cap)
|
|
: "d1", "a1");
|
|
|
|
return reg_d0;
|
|
}
|
|
static inline int
|
|
IOCS_S_READ (int pos, int blk, int id, int size, void *buf)
|
|
{
|
|
register int reg_d0 __asm ("d0");
|
|
|
|
__asm __volatile ("moveml d3-d5,sp@-\n\t"
|
|
"movel %2,d2\n\t"
|
|
"movel %3,d3\n\t"
|
|
"movel %4,d4\n\t"
|
|
"movel %5,d5\n\t"
|
|
"moval %6,a1\n\t"
|
|
"movel #0x26,d1\n\t"
|
|
"movel #0xf5,d0\n\t"
|
|
"trap #15\n\t"
|
|
"moveml sp@+,d3-d5"
|
|
: "=d" (reg_d0), "=m" (*(char*) buf)
|
|
: "ri" (pos), "ri" (blk), "ri" (id), "ri" (size), "g" ((int) buf)
|
|
: "d1", "d2", "a1");
|
|
|
|
return reg_d0;
|
|
}
|
|
|
|
static inline int
|
|
IOCS_S_READEXT (int pos, int blk, int id, int size, void *buf)
|
|
{
|
|
register int reg_d0 __asm ("d0");
|
|
|
|
__asm __volatile ("moveml d3-d5,sp@-\n\t"
|
|
"movel %2,d2\n\t"
|
|
"movel %3,d3\n\t"
|
|
"movel %4,d4\n\t"
|
|
"movel %5,d5\n\t"
|
|
"moval %6,a1\n\t"
|
|
"movel #0x26,d1\n\t"
|
|
"movel #0xf5,d0\n\t"
|
|
"trap #15\n\t"
|
|
"moveml sp@+,d3-d5"
|
|
: "=d" (reg_d0), "=m" (*(char*) buf)
|
|
: "ri" (pos), "ri" (blk), "ri" (id), "ri" (size), "g" ((int) buf)
|
|
: "d1", "d2", "a1");
|
|
|
|
return reg_d0;
|
|
}
|
|
|
|
#define PART_BOOTABLE 0
|
|
#define PART_UNUSED 1
|
|
#define PART_INUSE 2
|
|
|
|
|
|
|
|
int
|
|
bootmain(scsiid)
|
|
int scsiid;
|
|
{
|
|
struct iocs_readcap cap;
|
|
int size;
|
|
|
|
if (IOCS_BITSNS(0) & 1) /* ESC key */
|
|
return 0;
|
|
|
|
if (IOCS_S_READCAP(scsiid, &cap) < 0) {
|
|
IOCS_B_PRINT("Error in reading.\r\n");
|
|
return 0;
|
|
}
|
|
size = cap.size >> 9;
|
|
|
|
{
|
|
long *label = (void*) 0x3000;
|
|
if (IOCS_S_READ(0, 1, scsiid, size, label) < 0) {
|
|
IOCS_B_PRINT("Error in reading.\r\n");
|
|
return 0;
|
|
}
|
|
if (label[0] != 0x58363853 ||
|
|
label[1] != 0x43534931) {
|
|
IOCS_B_PRINT("Invalid disk.\r\n");
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
{
|
|
struct cpu_disklabel *label = (void*) 0x3000;
|
|
int i, firstinuse=-1;
|
|
|
|
if (IOCS_S_READ(2<<(2-size), size?2:1, scsiid, size, label) < 0) {
|
|
IOCS_B_PRINT("Error in reading.\r\n");
|
|
return 0;
|
|
}
|
|
if (*((long*) &label->dosparts[0].dp_typname) != 0x5836384b) {
|
|
IOCS_B_PRINT("Invalid disk.\r\n");
|
|
return 0;
|
|
}
|
|
|
|
for (i = 1; i < NDOSPART; i++) {
|
|
if (label->dosparts[i].dp_flag == PART_BOOTABLE)
|
|
break;
|
|
else if (label->dosparts[i].dp_flag == PART_INUSE)
|
|
firstinuse = i;
|
|
}
|
|
if (i >= NDOSPART && firstinuse >= 0)
|
|
i = firstinuse;
|
|
if (i < NDOSPART) {
|
|
unsigned int start = label->dosparts[i].dp_start;
|
|
unsigned int start1 = start << (2-size);
|
|
int r;
|
|
if ((start1 & 0x1fffff) == 0x1fffff)
|
|
r = IOCS_S_READ(start1,
|
|
8>>size,
|
|
scsiid,
|
|
size,
|
|
(void*) 0x2400);
|
|
else
|
|
r = IOCS_S_READEXT(start1,
|
|
8>>size,
|
|
scsiid,
|
|
size,
|
|
(void*) 0x2400);
|
|
if (r < 0) {
|
|
IOCS_B_PRINT ("Error in reading.\r\n");
|
|
return 0;
|
|
}
|
|
if (*((char*) 0x2400) != 0x60) {
|
|
IOCS_B_PRINT("Invalid disk.\r\n");
|
|
return 0;
|
|
}
|
|
asm volatile ("movl %0,d4\n\t"
|
|
"movl %1,d2\n\t"
|
|
"jsr 0x2400"
|
|
:
|
|
: "g" (scsiid), "g"(start)
|
|
: "d4");
|
|
return 0;
|
|
}
|
|
IOCS_B_PRINT ("No bootable partition.\r\n");
|
|
return 0;
|
|
}
|
|
|
|
return 0;
|
|
}
|