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