Home | History | Annotate | Line # | Download | only in common
srt0.S revision 1.4
      1 /*	$NetBSD: srt0.S,v 1.4 1999/03/05 11:12:16 pk Exp $	*/
      2 
      3 /*-
      4  * Copyright (c) 1999 The NetBSD Foundation, Inc.
      5  * All rights reserved.
      6  *
      7  * This code is derived from software contributed to The NetBSD Foundation
      8  * by Paul Kranenburg.
      9  *
     10  * Redistribution and use in source and binary forms, with or without
     11  * modification, are permitted provided that the following conditions
     12  * are met:
     13  * 1. Redistributions of source code must retain the above copyright
     14  *    notice, this list of conditions and the following disclaimer.
     15  * 2. Redistributions in binary form must reproduce the above copyright
     16  *    notice, this list of conditions and the following disclaimer in the
     17  *    documentation and/or other materials provided with the distribution.
     18  * 3. All advertising materials mentioning features or use of this software
     19  *    must display the following acknowledgement:
     20  *        This product includes software developed by the NetBSD
     21  *        Foundation, Inc. and its contributors.
     22  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23  *    contributors may be used to endorse or promote products derived
     24  *    from this software without specific prior written permission.
     25  *
     26  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36  * POSSIBILITY OF SUCH DAMAGE.
     37  */
     38 
     39 #define _LOCORE		/* XXX - fix Makefile */
     40 
     41 #include <machine/param.h>
     42 #include <machine/asm.h>
     43 #include <machine/psl.h>
     44 
     45 #define	CCFSZ	96
     46 
     47 	.file	"str0.s"
     48 
     49 	.comm	_C_LABEL(romp), 4
     50 	.comm	_C_LABEL(opf_romp), 4
     51 	.comm	_C_LABEL(cputyp), 4
     52 	.comm	_C_LABEL(nbpg), 4
     53 	.comm	_C_LABEL(pgofset), 4
     54 	.comm	_C_LABEL(pgshift), 4
     55 
     56 	.text
     57 	.globl	start
     58 
     59 start:
     60 	/*
     61 	 * Set up a stack.
     62 	 */
     63 	set	start, %o1
     64 	save	%o1, -CCFSZ, %sp
     65 
     66 	/*
     67 	 * Relocate.
     68 	 */
     69 1:	call	2f
     70 	 nop
     71 2:	add	%o7, (start-1b), %l0
     72 	set	start, %l1
     73 	set	_end, %o0
     74 	sub	%o0, %l1, %l2		! length
     75 3:	ld	[%l0], %o0
     76 	add	%l0, 4, %l0
     77 	st	%o0, [%l1]
     78 	subcc	%l2, 4, %l2
     79 	bg	3b
     80 	 add	%l1, 4, %l1
     81 
     82 	set	4f, %g1
     83 	jmp	%g1
     84 	 nop
     85 
     86 4:
     87 #ifdef notyet
     88 	/*
     89 	 * Enable traps
     90 	 */
     91 	wr	%g0, 0, %wim		! make sure we can set psr
     92 	nop; nop; nop
     93 	wr	%g0, PSR_S|PSR_PS|PSR_PIL, %psr	! set initial psr
     94 	nop; nop; nop
     95 	wr	%g0, 2, %wim		! set initial %wim (w1 invalid)
     96 
     97 	rd	%psr, %l0
     98 	wr	%l0, PSR_ET, %psr
     99 	nop; nop; nop
    100 #endif
    101 
    102 	/*
    103 	 * Clear BSS
    104 	 */
    105 	set     _edata, %o0             ! bzero(edata, end - edata)
    106 	set     _end, %o1
    107 	/* note: bzero() expanded inline for compactness */
    108 	subcc	%o1, %o0, %o1
    109 	bz	2f			! in case there is no BSS
    110 
    111 	srl	%o1, 2, %o1		! assume _edata & _end are aligned
    112 1:
    113 	st	%g0, [%o0]		! while (n--)
    114 	subcc	%o1, 1, %o1		!	*p = 0; etc..
    115 	bnz	1b
    116 	 add	%o0, 4, %o0
    117 2:
    118 
    119 	/*
    120 	 * Enable interrupts, but only above level 11. This enables "L1-A",
    121 	 * but avoids spurious interrupt bites from most other devices.
    122 	 */
    123 	rd	%psr, %o0
    124 	andn	%o0, PSR_PIL, %o0
    125 	wr	%o0, 0xb00, %psr	! (11 << 8)
    126 	nop; nop; nop
    127 
    128 	/*
    129 	 * Set CPU type that we are running on.
    130 	 */
    131 	sethi	%hi(_C_LABEL(cputyp)), %o0
    132 	set	0x4000, %g7
    133 	cmp	%i0, %g7
    134 	beq	is_sun4
    135 	 nop
    136 
    137 	mov	CPU_SUN4C, %g4
    138 	mov	SUN4CM_PGSHIFT, %g5
    139 
    140 	/*
    141 	 * Save address of PROM vector (passed in %i0).
    142 	 */
    143 	sethi	%hi(_C_LABEL(romp)), %o1
    144 	st	%i0, [%o1 + %lo(_C_LABEL(romp))]
    145 
    146 	/* Also save %i3, which is the Openfirmware entry, if any */
    147 	sethi	%hi(_C_LABEL(opf_romp)), %o1
    148 	st	%i3, [%o1 + %lo(_C_LABEL(opf_romp))]
    149 	b,a	is_sun4cm
    150 
    151 is_sun4:
    152 	mov	CPU_SUN4, %g4
    153 	mov	SUN4_PGSHIFT, %g5
    154 
    155 is_sun4cm:
    156 	st	%g4, [%o0 + %lo(_C_LABEL(cputyp))]
    157 	sethi	%hi(_C_LABEL(pgshift)), %o0	! pgshift = log2(nbpg)
    158 	st	%g5, [%o0 + %lo(_C_LABEL(pgshift))]
    159 
    160 	mov	1, %o0				! nbpg = 1 << pgshift
    161 	sll	%o0, %g5, %g5
    162 	sethi	%hi(_C_LABEL(nbpg)), %o0	! nbpg = bytes in a page
    163 	st	%g5, [%o0 + %lo(_C_LABEL(nbpg))]
    164 
    165 	sub	%g5, 1, %g5
    166 	sethi	%hi(_C_LABEL(pgofset)), %o0	! page offset = nbpg - 1
    167 	st	%g5, [%o0 + %lo(_C_LABEL(pgofset))]
    168 
    169 	call	_C_LABEL(main)
    170 	 mov	%i0, %o0
    171 
    172 	ret
    173 	 restore
    174 
    175 /*
    176  * NO-OP place holder function.
    177  */
    178 ENTRY(sparc_noop)
    179 	retl
    180 	 nop
    181 
    182 
    183 #ifdef TIGHT
    184 
    185 /*
    186  * XXX - Space saving .div & .rem routines (small & non-negative numbres only)
    187  */
    188 	.align	4
    189 	.global .div, .udiv
    190 ! int n = 0; while (a >= b) { a -= b; n++; }; return n;
    191 .div:
    192 .udiv:
    193 	cmp	%o0, %o1
    194 	bl	2f
    195 	 mov	0, %o5
    196 1:
    197 	sub	%o0, %o1, %o0
    198 	cmp	%o0, %o1
    199 	bge	1b
    200 	 add	%o5, 1, %o5
    201 2:
    202 	retl
    203 	 mov	%o5, %o0
    204 
    205 	.align	4
    206 	.global .rem, .urem
    207 ! while (a>=b) a -= b; return a;
    208 .rem:
    209 .urem:
    210 	cmp	%o0, %o1
    211 	bl	2f
    212 	 nop
    213 	sub	%o0, %o1, %o0
    214 1:
    215 	cmp	%o0, %o1
    216 	bge,a	1b
    217 	 sub	%o0, %o1, %o0
    218 2:
    219 	retl
    220 	 nop
    221 
    222 #endif /* TIGHT */
    223