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