Home | History | Annotate | Line # | Download | only in wdboot
wdboot.S revision 1.1.4.2
      1 /*	$NetBSD: wdboot.S,v 1.1.4.2 2004/08/03 10:33:35 skrll 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 #ifdef __ELF__
     36 	.globl	_start, main, fill
     37 
     38 	.text
     39 _start:
     40 #else
     41 	.globl	start, main, fill
     42 
     43 	.text
     44 start:
     45 #endif
     46 /*
     47  * in: d3 ('DMAr' flag), d4 (SCSI target), d5 (boot pref), d7 (ACSI target)
     48  */
     49 main:	lea	%pc@(regsav),%a0
     50 	movml	%d3-%d5/%d7,%sp@-
     51 	movl	%sp,%a0@
     52 
     53 	movw	#-1,%sp@-
     54 	movw	#Kbshift,%sp@-
     55 	trap	#BIOS
     56 	addql	#4,%sp
     57 
     58 	tstb	%d5
     59 	beqs	0f			| no boot preference
     60 	cmpb	#0x20,%d5
     61 	bnes	exit			| bootpref != NetBSD
     62 
     63 0:	btst	#3,%d0			| Alternate?
     64 	bnes	exit
     65 	subql	#1,%d0
     66 	movl	%d0,%a3			| autoboot flag
     67 
     68 	movl	_membot:w,%d3
     69 	lea	MAXBOT,%a4
     70 	cmpl	%a4,%d3
     71 	bhis	exit			| membot > MAXBOT
     72 
     73 	movl	_memtop:w,%d3
     74 	cmpl	#MINTOP,%d3
     75 	blts	exit			| memtop < MINTOP
     76 
     77 	andw	#-4,%d3
     78 	movl	%d3,%a0
     79 	movl	%sp,%a0@-
     80 	movl	%a0,%sp			| set new stack
     81 
     82 	movq	#NSEC,%d5		| sector count
     83 	movq	#1,%d6			| first sector
     84 	bsrs	rds0
     85 	tstl	%d0
     86 	bnes	0f
     87 /*
     88  * loader (readsector, disklabel, autoboot)
     89  */
     90 	pea	%a3@			| autoboot
     91 	pea	%a4@(LBLST-MAXBOT)	| disklabel
     92 	pea	%pc@(rds1)		| readsector
     93 	jsr	%a4@(BXXST-MAXBOT)
     94 	lea	%sp@(12),%sp		| NetBSD not booted
     95 
     96 0:	movl	%sp@,%sp			| restore BIOS stack
     97 	tstl	%d0
     98 	bmis	exit
     99 	movl	%d0,%sp@(8)		| new boot preference
    100 
    101 exit:	movml	%sp@+,%d3-%d5/%d7
    102 	rts
    103 
    104 /*
    105  * int readsec (void *buffer, u_int offset, u_int count);
    106  */
    107 rds1:	movml	%d2-%d7/%a2-%a6,%sp@-
    108 	movl	%pc@(regsav),%a0
    109 	movml	%a0@,%d3-%d5/%d7
    110 	movl	%sp@(48),%a4		| buffer
    111 	movl	%sp@(52),%d6		| offset
    112 	movl	%sp@(56),%d3		| count
    113 0:	movl	#255,%d5
    114 	cmpl	%d5,%d3
    115 	bccs	1f
    116 	movl	%d3,%d5
    117 1:	bsrs	rds0
    118 	tstl	%d0
    119 	bnes	2f
    120 	addl	#(255*512),%a4
    121 	addl	%d5,%d6
    122 	subl	%d5,%d3
    123 	bnes	0b
    124 2:	movml	%sp@+,%d2-%d7/%a2-%a6
    125 	rts
    126 /*
    127  * in:  d4 (target) d5 (count), d6 (offset), a4 (buffer)
    128  * out: d0 (<= 0)
    129  * mod: d0, d1, d2, a0, a1, a5, a6
    130  */
    131 rds0:	lea	%pc@(dpar),%a6
    132 	tstb	%a6@
    133 	bnes	0f
    134 	movb	%d4,%d0
    135 	andb	#1,%d0
    136 	aslb	#4,%d0
    137 	orb	#0xa0,%d0
    138 	movb	%d0,idesdh:l
    139 	movl	%a4,%a0
    140 	movq	#0,%d1
    141 	movb	#0,idedor:l
    142 	movb	#0xec,idecr:l		| IDENTIFY DRIVE
    143 	bsrs	wait
    144 	bnes	err
    145 	movb	%a4@(7),%a6@		| tracks/cylinder
    146 	movb	%a4@(13),%a6@(1)		| sectors/track
    147 0:	movl	%d6,%d1
    148 	movq	#0,%d0
    149 	movb	%a6@(1),%d0
    150 	movq	#0,%d2
    151 	movb	%a6@,%d2
    152 	mulu	%d0,%d2
    153 	divu	%d2,%d1
    154 	movb	%d1,idecl:l
    155 	lsrl	#8,%d1
    156 	movb	%d1,idech:l
    157 	lsrl	#8,%d1
    158 	divu	%d0,%d1
    159 	movb	%d4,%d0
    160 	andb	#1,%d0
    161 	aslb	#4,%d0
    162 	orb	%d0,%d1
    163 	orb	#0xa0,%d1
    164 	movb	%d1,idesdh:l
    165 	swap	%d1
    166 	addqw	#1,%d1
    167 	movb	%d1,idesn:l
    168 	movl	%a4,%a0
    169 	movb	%d5,idesc:l
    170 	movw	%d5,%d1
    171 	subqw	#1,%d1
    172 	movb	#0,idedor:l
    173 	movb	#0x20,idecr:l
    174 wait:	movl	#0x7d0,%d0
    175 	addl	_hz_200:w,%d0
    176 2:	btst	#5,gpip:w
    177 	beqs	3f
    178 	cmpl	_hz_200:w,%d0
    179 	bhis	2b
    180 err:	movq	#-1,%d0
    181 	rts
    182 3:	movb	idesr:l,%d0
    183 	btst	#0,%d0
    184 	bnes	err
    185 	btst	#3,%d0
    186 	beqs	err
    187 	movq	#63,%d0
    188 	lea	idedr:l,%a1
    189 4:	movw	%a1@,%a0@+
    190 	movw	%a1@,%a0@+
    191 	movw	%a1@,%a0@+
    192 	movw	%a1@,%a0@+
    193 	dbra	%d0,4b
    194 	dbra	%d1,wait
    195 	movq	#0,%d0
    196 	rts
    197 
    198 regsav:	.long	0
    199 
    200 fill:	.space	30
    201 
    202 dpar:	.byte	0			| tracks/cylinder
    203 	.byte	0			| sectors/track
    204 
    205 	.ascii	"NetBSD"
    206 hd_siz:	.long	0
    207 p0_dsc:	.long	0, 0, 0
    208 p1_dsc:	.long	0, 0, 0
    209 p2_dsc:	.long	0, 0, 0
    210 p3_dsc:	.long	0, 0, 0
    211 bsl_st:	.long	0
    212 bsl_sz:	.long	0
    213 	.word	0
    214 end:
    215