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