Home | History | Annotate | Line # | Download | only in wdboot
wdboot.S revision 1.3
      1 /*	$NetBSD: wdboot.S,v 1.3 2022/06/26 14:14:46 tsutsui Exp $	*/
      2 
      3 /*
      4  * Copyright (c) 1995 Waldi Ravens
      5  * All rights reserved.
      6  *
      7  * Redistribution and use in source and binary forms, with or without
      8  * modification, are permitted provided that the following conditions
      9  * are met:
     10  * 1. Redistributions of source code must retain the above copyright
     11  *    notice, this list of conditions and the following disclaimer.
     12  * 2. Redistributions in binary form must reproduce the above copyright
     13  *    notice, this list of conditions and the following disclaimer in the
     14  *    documentation and/or other materials provided with the distribution.
     15  * 3. All advertising materials mentioning features or use of this software
     16  *    must display the following acknowledgement:
     17  *        This product includes software developed by Waldi Ravens.
     18  * 4. The name of the author may not be used to endorse or promote products
     19  *    derived from this software without specific prior written permission
     20  *
     21  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     22  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     23  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     24  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     25  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     26  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     27  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     28  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     29  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     30  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     31  */
     32 
     33 #include "xxboot.h"
     34 
     35 	.globl	_start, main, fill
     36 
     37 	.text
     38 _start:
     39 /*
     40  * in: d3 ('DMAr' flag), d4 (SCSI target), d5 (boot pref), d7 (ACSI target)
     41  */
     42 main:	lea	%pc@(regsav),%a0
     43 	movml	%d3-%d5/%d7,%sp@-
     44 	movl	%sp,%a0@
     45 
     46 	movw	#-1,%sp@-
     47 	movw	#Kbshift,%sp@-
     48 	trap	#BIOS
     49 	addql	#4,%sp
     50 
     51 	tstb	%d5
     52 	beqs	0f			| no boot preference
     53 	cmpb	#0x20,%d5
     54 	bnes	exit			| bootpref != NetBSD
     55 
     56 0:	btst	#3,%d0			| Alternate?
     57 	bnes	exit
     58 	subql	#1,%d0
     59 	movl	%d0,%a3			| autoboot flag
     60 
     61 	movl	_membot:w,%d3
     62 	lea	MAXBOT,%a4
     63 	cmpl	%a4,%d3
     64 	bhis	exit			| membot > MAXBOT
     65 
     66 	movl	_memtop:w,%d3
     67 	cmpl	#MINTOP,%d3
     68 	blts	exit			| memtop < MINTOP
     69 
     70 	andw	#-4,%d3
     71 	movl	%d3,%a0
     72 	movl	%sp,%a0@-
     73 	movl	%a0,%sp			| set new stack
     74 
     75 	movq	#NSEC,%d5		| sector count
     76 	movq	#1,%d6			| first sector
     77 	bsrs	rds0
     78 	tstl	%d0
     79 	bnes	0f
     80 /*
     81  * loader (readsector, disklabel, autoboot)
     82  */
     83 	pea	%a3@			| autoboot
     84 	pea	%a4@(LBLST-MAXBOT)	| disklabel
     85 	pea	%pc@(rds1)		| readsector
     86 	jsr	%a4@(BXXST-MAXBOT)
     87 	lea	%sp@(12),%sp		| NetBSD not booted
     88 
     89 0:	movl	%sp@,%sp			| restore BIOS stack
     90 	tstl	%d0
     91 	bmis	exit
     92 	movl	%d0,%sp@(8)		| new boot preference
     93 
     94 exit:	movml	%sp@+,%d3-%d5/%d7
     95 	rts
     96 
     97 /*
     98  * int readsec (void *buffer, u_int offset, u_int count);
     99  */
    100 rds1:	movml	%d2-%d7/%a2-%a6,%sp@-
    101 	movl	%pc@(regsav),%a0
    102 	movml	%a0@,%d3-%d5/%d7
    103 	movl	%sp@(48),%a4		| buffer
    104 	movl	%sp@(52),%d6		| offset
    105 	movl	%sp@(56),%d3		| count
    106 0:	movl	#255,%d5
    107 	cmpl	%d5,%d3
    108 	bccs	1f
    109 	movl	%d3,%d5
    110 1:	bsrs	rds0
    111 	tstl	%d0
    112 	bnes	2f
    113 	addl	#(255*512),%a4
    114 	addl	%d5,%d6
    115 	subl	%d5,%d3
    116 	bnes	0b
    117 2:	movml	%sp@+,%d2-%d7/%a2-%a6
    118 	rts
    119 /*
    120  * in:  d4 (target) d5 (count), d6 (offset), a4 (buffer)
    121  * out: d0 (<= 0)
    122  * mod: d0, d1, d2, a0, a1, a5, a6
    123  */
    124 rds0:	lea	%pc@(dpar),%a6
    125 	tstb	%a6@
    126 	bnes	0f
    127 	movb	%d4,%d0
    128 	andb	#1,%d0
    129 	aslb	#4,%d0
    130 	orb	#0xa0,%d0
    131 	movb	%d0,idesdh:l
    132 	movl	%a4,%a0
    133 	movq	#0,%d1
    134 	movb	#0,idedor:l
    135 	movb	#0xec,idecr:l		| IDENTIFY DRIVE
    136 	bsrs	wait
    137 	bnes	err
    138 	movb	%a4@(7),%a6@		| tracks/cylinder
    139 	movb	%a4@(13),%a6@(1)		| sectors/track
    140 0:	movl	%d6,%d1
    141 	movq	#0,%d0
    142 	movb	%a6@(1),%d0
    143 	movq	#0,%d2
    144 	movb	%a6@,%d2
    145 	mulu	%d0,%d2
    146 	divu	%d2,%d1
    147 	movb	%d1,idecl:l
    148 	lsrl	#8,%d1
    149 	movb	%d1,idech:l
    150 	lsrl	#8,%d1
    151 	divu	%d0,%d1
    152 	movb	%d4,%d0
    153 	andb	#1,%d0
    154 	aslb	#4,%d0
    155 	orb	%d0,%d1
    156 	orb	#0xa0,%d1
    157 	movb	%d1,idesdh:l
    158 	swap	%d1
    159 	addqw	#1,%d1
    160 	movb	%d1,idesn:l
    161 	movl	%a4,%a0
    162 	movb	%d5,idesc:l
    163 	movw	%d5,%d1
    164 	subqw	#1,%d1
    165 	movb	#0,idedor:l
    166 	movb	#0x20,idecr:l
    167 wait:	movl	#0x7d0,%d0
    168 	addl	_hz_200:w,%d0
    169 2:	btst	#5,gpip:w
    170 	beqs	3f
    171 	cmpl	_hz_200:w,%d0
    172 	bhis	2b
    173 err:	movq	#-1,%d0
    174 	rts
    175 3:	movb	idesr:l,%d0
    176 	btst	#0,%d0
    177 	bnes	err
    178 	btst	#3,%d0
    179 	beqs	err
    180 	movq	#63,%d0
    181 	lea	idedr:l,%a1
    182 4:	movw	%a1@,%a0@+
    183 	movw	%a1@,%a0@+
    184 	movw	%a1@,%a0@+
    185 	movw	%a1@,%a0@+
    186 	dbra	%d0,4b
    187 	dbra	%d1,wait
    188 	movq	#0,%d0
    189 	rts
    190 
    191 regsav:	.long	0
    192 
    193 fill:	.space	30
    194 
    195 dpar:	.byte	0			| tracks/cylinder
    196 	.byte	0			| sectors/track
    197 
    198 	.ascii	"NetBSD"
    199 hd_siz:	.long	0
    200 p0_dsc:	.long	0, 0, 0
    201 p1_dsc:	.long	0, 0, 0
    202 p2_dsc:	.long	0, 0, 0
    203 p3_dsc:	.long	0, 0, 0
    204 bsl_st:	.long	0
    205 bsl_sz:	.long	0
    206 	.word	0
    207 end:
    208