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