boot.S revision 1.4 1 | file: boot.S
2 | author: chapuni(webmaster@chapuni.com)
3 | Yasha(itohy@netbsd.org)
4 |
5 | $NetBSD: boot.S,v 1.4 2001/11/24 16:22:54 minoura Exp $
6
7 #include <machine/asm.h>
8 #include "iocscall.h"
9
10 #define BASEOFF 0x8000
11 #define BASEPTR_A (TEXTADDR+BASEOFF)
12 #define BASEPTR_R %pc@(top+BASEOFF:W)
13
14 #define SRAM 0x00ED0000 /* SRAM stat addr */
15 #define SRAM_MEMSZ (SRAM + 8) /* (L) size of main memory */
16 #define MINMEM 0x00400000 /* at least 4MB required */
17
18 #define BOOT_ERROR(s) jbsr boot_error; .asciz s; .even
19
20 .globl _C_LABEL(bootufs)
21 .text
22 ASENTRY_NOPROFILE(start)
23 ASENTRY_NOPROFILE(top)
24 bras _ASM_LABEL(entry0)
25 .ascii "SHARP/"
26 .ascii "X680x0"
27 .word 0x8199,0x94e6,0x82ea,0x82bd
28 .word 0x8e9e,0x82c9,0x82cd,0x8cbb
29 .word 0x8ec0,0x93a6,0x94f0,0x8149
30 .word 0
31 | 0x2000 (FD), 0x2400 (SASI/SCSI) ( 0x0f0000)
32 | d4 SCSI ID
33 | jmp
34 ASENTRY_NOPROFILE(entry0)
35 moveml %d0-%d7/%a0-%a7,_C_LABEL(startregs)
36 lea BASEPTR_A:l,%a5 | set base ptr
37 #define _RELOC(adr) %a5@(((adr)-(BASEPTR_A&0xffff)):W)
38 #define ASRELOC(var) _RELOC(_ASM_LABEL(var))
39 #define RELOC(var) _RELOC(_C_LABEL(var))
40
41 lea RELOC(edata),%a1
42 bra _ASM_LABEL(entry)
43
44 | Disklabel= 404bytes
45 | Since LABELLOFFSET in <machine/disklabel.h> is 0x40,
46 | entry must be after 0x000001d4 (0x000f01d4)
47 disklabel:
48 .space 406
49
50 ASENTRY_NOPROFILE(entry)
51 movew #_end-1,%d0 | bss end (low word only)
52
53 | clear out bss (must be <= 64KB)
54 subw %a1,%d0
55 clrbss: clrb %a1@+
56 dbra %d0,clrbss
57
58 movel %d4,RELOC(ID) | SCSI ID (if booted from SCSI)
59
60 | set system stack
61 lea ASRELOC(top),%a1 | set stack pointer to 0x000F0000
62 lea %a1@,%sp | a1 will be used later for IOCS calls
63
64 | we use 68020 instructions, and check MPU beforehand
65 |
66 | here d1.w = -1, and the above "subw a1,d0" = 0x9049, and
67 | if MPU <= 010 loads 0x49,
68 | if MPU >= 020 loads 0x90.
69 | This is a move, not a tst instruction
70 | because pc-relative tsts are not availble on 000/010.
71 chkmpu: moveb %pc@(clrbss-chkmpu-2:B,%d0:W:2),%d0 | 103B 02xx
72 jmi mpuok | MC68020 or later
73 BOOT_ERROR("MPU 68000?")
74 mpuok: | XXX check for MMU?
75
76 IOCS(__BOOTINF)
77 lsll #8,%d0 | clear MSByte
78 lsrl #8,%d0 |
79 movel %d0,RELOC(BOOT_INFO)
80
81 |
82 | 0x80...0x8F SASI
83 | 0x90...0x93 Floppy
84 | 0xED0000...0xED3FFE SRAM
85 | others ROM (SCSI?)
86 |
87 movel %d0,%d1
88 clrb %d1
89 tstl %d1
90 jne boot_ram_rom
91 |
92 | SASI or Floppy
93 |
94 movel %d0,%d2
95 andib #0xFC,%d0
96 cmpib #0x90,%d0
97 jne boot_dev_unsupported | boot from SASI?
98 |
99 | Floppy
100 |
101 moveb %d2,%d0
102 andib #0x03,%d0 | drive # (head=0)
103 jbsr check_fd_format
104 moveml %d0-%d1,RELOC(FDSECMINMAX) | min and max sec #
105 lslw #8,%d2
106 moveq #0x70,%d1
107 orw %d2,%d1 | PDA*256 + MODE
108 movel %d1,RELOC(FDMODE)
109 movel %d0,%d2 | read position (first sector)
110 movel #8192,%d3 | read bytes
111 IOCS(__B_READ)
112 jra boot_read_done
113
114 #include "chkfmt.s"
115
116 boot_ram_rom:
117 movel %d0,%d1
118 swap %d1
119 cmpiw #0x00ED,%d1
120 jne boot_SCSI
121 | boot from SRAM?
122
123 boot_dev_unsupported:
124 BOOT_ERROR("unsupported boot device")
125
126 |
127 | volatile void BOOT_ERROR(const char *msg);
128 | print error message, wait for key press and reboot
129 |
130 booterr_msg: .ascii "\r\n\n"
131 .ascii BOOT
132 .asciz ": "
133 reboot_msg: .asciz "\r\n[Hit key to reboot]"
134 .even
135
136 ENTRY_NOPROFILE(BOOT_ERROR)
137 addql #4,%sp
138
139 boot_error: lea %pc@(booterr_msg),%a1
140 IOCS(__B_PRINT)
141 moveal %sp@+,%a1
142 IOCS(__B_PRINT)
143 lea %pc@(reboot_msg),%a1
144 IOCS(__B_PRINT)
145
146 | wait for a key press (or release of a modifier)
147 IOCS(__B_KEYINP)
148
149 | issue software reset
150 trap #10
151 | NOTREACHED
152
153
154 |
155 | ROM boot ... probably from SCSI
156 |
157 boot_SCSI:
158 #ifdef SCSI_ADHOC_BOOTPART
159 |
160 | Find out boot partition in an ad hoc manner.
161 |
162
163 | get block length of the SCSI disk
164 SCSIIOCS(__S_READCAP) | using buffer at a1
165 tstl %d0
166 jeq 1f
167 BOOT_ERROR("READCAP failed")
168 1: moveq #0,%d5
169 moveb %a1@(6),%d5 | 1: 256, 2: 512, 4: 1024
170 lsrb #1,%d5 | 0: 256, 1: 512, 2: 1024
171 movel %d5,RELOC(SCSI_BLKLEN)
172
173 | find out the start position of the boot partition
174 | XXX VERY AD HOC
175 |
176 | ROM firmware:
177 | pass read pos (in block #) in d2
178 | Human68k-style partition table does not exist
179 | d2 is 4 at the maximum
180 | SCSI IPLs (genuine and SxSI):
181 | pass read pos (in kilobytes) in d2
182 | d2 is bigger than 0x20
183 | partition table on the memory is destroyed
184 | BOOT MENU Ver.2.22:
185 | passes partition table entry address in a0
186 | d2 is cleared to zero
187 | No other IPL is supported. XXX FIXME
188 tstl %d2
189 jne sc1
190 | no information in d2 -- probably from BOOT MENU
191 | a0 points the partiion table entry
192 movel %a0@(0x0008),%d2 | in KByte
193 sc1: cmpl #0x20,%d2
194 jcs sc2
195 lsll #8,%d2 | clear MSByte
196 lsrl #6,%d2 |
197 lsrl %d5,%d2 | in sector
198 sc2:
199 | read entire boot
200 moveq #8192/256,%d3 | size is 8KB
201 lsrl %d5,%d3 | in sector
202 jbsr scsiread | read at %a1
203
204 cmpil #5,%d2
205 bcc sc3
206 movql #0,%d2
207 sc3: movel %d2,RELOC(SCSI_PARTTOP)
208 #else
209 moveq #1,%d5 | 512bytes/sec
210 movel %d5,%sp@-
211 moveq #8192/512,%d3 |
212 moveq #0x40,%d2 | (sd*a )
213 SCSIIOCS(__S_READ)
214 #endif
215
216 boot_read_done:
217 jmp first_kbyte
218
219 read_error: BOOT_ERROR("read error")
220
221 #undef RELOC /* base register a5 is no longer available */
222 #undef ASRELOC
223 #undef _RELOC
224
225 |
226 | read SCSI
227 |
228 | input: d2.l: pos in sector
229 | d3.l: len in sector
230 | d4: target SCSI ID
231 | d5: sector length (0: 256, 1: 512, 2: 1024)
232 | a1: buffer address
233 | destroy:
234 | d0, d1, a1
235 |
236 scsiread:
237 moveml %d2-%d3/%d6-%d7/%a2,%sp@-
238 | if (pos >= 0x200000 || (len > 255 && pos + len >= 0x200000))
239 | use READEXT
240 | else
241 | use READ
242 moveq #0x20,%d0
243 swap %d0 | d0.l = 0x00200000
244 moveq #0,%d6
245 subqb #1,%d6 | d6.l = 255
246 moveq #8,%d7
247 addb %d5,%d7 | d7.b = (sector length: 0-2) + 8
248 cmpl %d0,%d2
249 jcc scsiread_ext
250 moveq #__S_READ,%d1
251 cmpl %d3,%d6
252 jcc scsiread_noext
253 subl %d2,%d0 | d0.0 = 0x200000 - pos
254 cmpl %d0,%d3 | <= len
255 jcs scsiread_noext | no
256
257 scsiread_ext: | use READEXT
258 extw %d6 | d6.l = 65535
259 moveq #__S_READEXT,%d1
260
261 scsiread_noext: | use READ
262 loop_scsiread:
263 | d1: SCSI IOCS call #
264 | d6: max sector count at a time
265 movel %d3,%a2 | save original len in a2
266 cmpl %d3,%d6
267 jcc 1f
268 movel %d6,%d3
269 1: IOCS(__SCSIDRV) | SCSIIOCS(d1)
270 tstl %d0
271 jne read_error
272 movel %d3,%d0 | addr += read count << (8 + sec len)
273 asll %d7,%d0
274 addl %d0,%a1
275 exg %d3,%a2 | restore original len to d3
276 addl %a2,%d2 | pos += read count
277 subl %a2,%d3 | len -= read count
278 jne loop_scsiread
279 moveml %sp@+,%d2-%d3/%d6-%d7/%a2
280 rts
281
282 |
283 | The former part must reside in the first 1KB.
284 |
285 .globl first_kbyte
286 first_kbyte:
287 |--------------------------------------------------------------------------
288 |
289 | The latter text+data part is not accessible at the first boot time.
290 | PC-relative can be used from here.
291 |
292 jmp _C_LABEL(bootufs) | 0x0Fxxxx
293
294 .word 0
295
296 | int badbaddr __P((caddr_t adr));
297 | check if the given address is valid for byte read
298 | return: 0: valid, 1: not valid
299
300 ENTRY_NOPROFILE(badbaddr)
301 lea 0x0008:W,%a1 | MPU Bus Error vector
302 moveq #1,%d0
303 lea %pc@(badr1),%a0
304 movew %sr,%sp@-
305 oriw #0x0700,%sr | keep out interrupts
306 movel %a1@,%sp@-
307 movel %a0,%a1@ | set bus error vector
308 movel %sp,%d1 | save sp
309 moveal %sp@(10),%a0
310 tstb %a0@ | try read...
311 moveq #0,%d0 | this is skipped on bus error
312 badr1: moveal %d1,%sp | restore sp
313 movel %sp@+,%a1@
314 movew %sp@+,%sr
315 rts
316
317 | void RAW_READ __P((void *buf, u_int32_t blkpos, size_t bytelen));
318 | inputs:
319 | buf: input buffer address
320 | blkpos: read start position in the partition in 512byte-blocks
321 | bytelen: read length in bytes
322
323 Lraw_read_buf=4+(4*11)
324 Lraw_read_pos_=Lraw_read_buf+4
325 Lraw_read_len=Lraw_read_buf+8
326
327 #ifdef SCSI_ADHOC_BOOTPART
328 | RAW_READ of physical disk
329 ENTRY_NOPROFILE(RAW_READ0)
330 moveq #0,%d0
331 jra raw_read1
332 #endif
333
334 ENTRY_NOPROFILE(RAW_READ)
335 #ifdef SCSI_ADHOC_BOOTPART
336 movel _C_LABEL(SCSI_PARTTOP),%d0
337 raw_read1:
338 #endif
339 moveml %d2-%d7/%a2-%a6,%sp@-
340 moveml %sp@(Lraw_read_buf),%d1-%d3
341 movel %d1,%a1
342 | d2.l: pos in 512byte-blocks
343 | d3.l: length in bytes
344 | a1 (=d1): buffer address
345
346 lea BASEPTR_R,%a5 | set base ptr
347 #define _RELOC(adr) %a5@(((adr)-(BASEPTR_A&0xffff)):W)
348 #define ASRELOC(var) _RELOC(_ASM_LABEL(var))
349 #define RELOC(var) _RELOC(_C_LABEL(var))
350
351 tstb _RELOC(_C_LABEL(BOOT_INFO)+1) | simple check. may be incorrect!
352 beqs raw_read_floppy
353
354 raw_read_scsi:
355 movel RELOC(ID),%d4 | SCSI ID
356 #ifdef SCSI_ADHOC_BOOTPART
357 movel RELOC(SCSI_BLKLEN),%d5 | sector size: 0-2
358 | XXX length must be sector aligned
359 lsrl #8,%d3 | size in 256byte-blocks
360 lsrl %d5,%d3 | size in sector
361 bcss read_half | minimal error check
362 lsll #1,%d2 | X flag and d2: pos in 256byte-blocks
363 roxrl %d5,%d2 | pos in sector
364 addl %d0,%d2 | physical pos in sector
365 #else
366 moveq #1,%d5 | 512bytes/sec
367 moveq #9,%d0 | shift count
368 addl #511,%d3
369 lsrl %d0,%d3
370 bcss read_half | minimal error check
371
372 addl #0x40,%d2 | 'a' partition starts here
373 #endif
374 | jcc 1f
375 | BOOT_ERROR("out of seek") | pos exceeds 32bit
376 |1:
377 jbsr scsiread
378 bras raw_read_end
379
380 raw_read_floppy:
381 |
382 | Floppy read routine
383 |
384
385 | convert to seek position
386
387 asll #2,%d2 | size in 128byte-blocks
388
389 | sec = raw_read_pos (d2)
390 | sec >>= 7 + (sector length: 0-3)
391
392 lea RELOC(FDSECMINMAX),%a0
393 moveq #0,%d1
394 moveb %a0@,%d1 | d1: sector length (0-3)
395 lsrl %d1,%d2 | d2: pos in sector
396 bcss read_half | error check
397
398 | trk = sec / (# sectors)
399 | sec = sec % (# sectors)
400
401 moveb %a0@(7),%d1 | d1: max sector #
402 subb %a0@(3),%d1 | - min sector #
403 addqb #1,%d1 | d1: # sectors
404 divu %d1,%d2 | d2: (sec << 16) | track
405
406 | position = (sec length << 24) | (track/2 << 16)
407 | | (track%2 << 8) | (min sec # + sec)
408
409 movel %a0@,%d0 | d0: (sec len << 24) | min sec #
410 lsrw #1,%d2 | d2: (sec << 16) | (track / 2)
411 jcc 1f
412 bset #8,%d0 | |= (track % 2) << 8
413 1: swap %d2 | d2: ((track / 2) << 16) | sec
414 addl %d0,%d2 | d2: position
415
416 | read
417 movel RELOC(FDMODE),%d1 | PDA*256 + MODE
418
419 | B_READ (for floppy)
420 | d1.w: PDA x 256 + MODE
421 | PDA: 0x90 (drive 0) ... 0x93 (drive 3)
422 | MODE: bit6: MFM
423 | bit5: retry
424 | bit4: seek
425 | d2.l: position
426 | bit31-24: sector length (0: 128, 1: 256, 2: 512, 3: 1K)
427 | bit23-16: track # (0-79)
428 | bit15-08: side (0 or 1)
429 | bit07-00: sector # (1-)
430 | d3.l: read bytes
431 | a1: read address
432 | return:
433 | d0: bit 31-24 ST0
434 | bit 23-16 ST1
435 | bit 15- 8 ST2
436 | bit 7- 0 C
437 | -1 on parameter error
438 | destroy: d0, d2, d3, a1
439 IOCS(__B_READ)
440 andil #0xf8ffff00,%d0 | check status (must be zero)
441 jne read_error
442
443 raw_read_end:
444 moveml %sp@+,%a2-%a6/%d2-%d7
445 rts
446 #undef _RELOC /* base register a5 is no longer available */
447 #undef ASRELOC
448 #undef RELOC
449
450 read_half: BOOT_ERROR("read half of block")
451
452
453 ENTRY_NOPROFILE(B_KEYINP)
454 IOCS(__B_KEYINP)
455 rts
456
457 ENTRY_NOPROFILE(B_PUTC)
458 movel %sp@(4),%d1
459 IOCS(__B_PUTC)
460 rts
461
462 ENTRY_NOPROFILE(B_PRINT)
463 movel %sp@(4),%a1
464 IOCS(__B_PRINT)
465 rts
466
467 |
468 | void memcpy(void *dst, const void *src, size_t count);
469 | void memmove(void *dst, const void *src, size_t count);
470 |
471 | small and slow memcpy...
472 | THIS FUNCTION DOES NOT CONFORM THE ANSI STANDARD
473 |
474 ENTRY_NOPROFILE(memcpy)
475 ENTRY_NOPROFILE(memmove)
476 lea %sp@(12),%a1
477 movel %a1@,%d1 | count
478 jeq Lmcpret
479 moveal %a1@-,%a0 | src
480 moveal %a1@-,%a1 | dest
481 cmpl %a1,%a0
482 jcc Lmcpfw
483 | copy backward
484 addal %d1,%a0
485 addal %d1,%a1
486 1: moveb %a0@-,%a1@-
487 subql #1,%d1
488 jne 1b
489 jra Lmcpret
490 Lmcpfw: | copy forward
491 1: moveb %a0@+,%a1@+
492 subql #1,%d1
493 jne 1b
494 Lmcpret:
495 | movel %sp@(8),%d0 | uncomment this to conform ANSI
496 rts
497
498
499 |
500 | global variables
501 |
502 BSS(ID, 4) | SCSI ID
503 BSS(BOOT_INFO, 4) | result of IOCS(__BOOTINF)
504 BSS(FDMODE, 4) | Floppy access mode: PDA x 256 + MODE
505 BSS(FDSECMINMAX, 8) | +0: (min sector) sector length
506 | +1: (min sector) track #
507 | +2: (min sector) side
508 | +3: (min sector) sector #
509 | +4: (max sector) sector length
510 | +5: (max sector) track #
511 | +6: (max sector) side
512 | +7: (max sector) sector #
513 #ifdef SCSI_ADHOC_BOOTPART
514 BSS(SCSI_PARTTOP, 4) | start sector of boot partition
515 BSS(SCSI_BLKLEN ,4) | sector len 0: 256, 1: 512, 2: 1024
516 #endif
517