Home | History | Annotate | Line # | Download | only in boot_ufs
      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.19     isaki | $NetBSD: boot.S,v 1.19 2020/01/28 11:57:22 isaki Exp $
      6  1.15     isaki 
      7  1.15     isaki |
      8  1.15     isaki | (1) IPL (or previous stage loader) loads first 1KB of this primary
      9  1.15     isaki |     bootloader to (*).  (*) is 0x2000 (from FD) or 0x2400 (from SASI/SCSI).
     10  1.15     isaki |
     11  1.15     isaki | (2) The first 1KB loads full primary bootloader (including first 1KB) from
     12  1.17     isaki |     the boot partition to 0x3000.  And jump to there.
     13  1.15     isaki |
     14  1.15     isaki | (3) The full primary bootloader loads the secondary bootloader known as
     15  1.15     isaki |     /boot from its filesystem to 0x6000.  And jump to there.
     16  1.15     isaki |
     17  1.15     isaki | Therefore, The first 1KB must be relocatable.
     18  1.15     isaki | The first 1KB must be smaller than or equal to 1024 bytes.
     19  1.15     isaki |
     20  1.15     isaki |       (1)         ->        (2)         ->        (3)
     21  1.15     isaki |  +------------+        +------------+        +------------+    0x000000
     22  1.15     isaki |  :            :        :            :        :            :
     23  1.15     isaki |  +------------+        +------------+        +------------+    (*)
     24  1.15     isaki |  | first 1KB  |        | first 1KB  |        | first 1KB  |
     25  1.15     isaki |  +------------+        +------------+        +------------+    (*)+0x400
     26  1.15     isaki |  :            :        :            :        :            :
     27  1.17     isaki |  :            :        +------------+        +------------+    0x003000
     28  1.17     isaki |  :            :        |full primary|        |full primary|
     29  1.17     isaki |  :            :        |boot loader |        |boot loader |
     30  1.19     isaki |  :            :        |(text+data) |        |(text+data) |
     31  1.19     isaki |  :            :        +------------+        +------------+    0x005000
     32  1.19     isaki |  :            :        |(bss)       |        |(bss)       |
     33  1.19     isaki |  :            :        +------------+        +------------+    0x006000
     34  1.15     isaki |  :            :        :            :        | /boot      |
     35  1.15     isaki |  :            :        :            :        +------------+
     36  1.15     isaki |  :            :        :            :        :            :
     37  1.15     isaki |  ~            ~        ~            ~        ~            ~
     38  1.15     isaki |  :            :        :            :<-SP    :            :<-SP
     39  1.17     isaki |  + - - - - - -+        + - - - - - -+        + - - - - - -+    0x100000
     40  1.15     isaki |  :            :        :            :        :            :
     41  1.15     isaki |
     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.17     isaki 		lea	TEXTADDR:W,%a5	| set base ptr
     67  1.17     isaki #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.18     isaki 		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.11     isaki |	Since LABELOFFSET in <machine/disklabel.h> is 0x40,
     76   1.1   minoura |	entry must be after 0x000001d4 (0x000f01d4)
     77  1.13     isaki 		.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.17     isaki 		lea	0x00100000,%sp	| set system stack
     92  1.17     isaki 		lea	%a5@,%a1	| set load address
     93  1.17     isaki 					| 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.16     isaki 		| 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.14     isaki 		| Initialize the screen here.  Some IPL (060turbo ROM or
    324  1.14     isaki 		| genuine boot selector) don't initialize the screen.
    325  1.14     isaki 		| Such initialization should be done as early as possible
    326  1.14     isaki 		| but it's too severe to place it in first_kbyte area.
    327  1.14     isaki 		| Therefore do it here.
    328  1.14     isaki 		moveq	#0x10,%d1
    329  1.14     isaki 		IOCS(__CRTMOD)
    330  1.14     isaki 
    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.17     isaki 		lea	TEXTADDR:W,%a5	| set base ptr
    386  1.17     isaki #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