Home | History | Annotate | Line # | Download | only in arm32
spl.S revision 1.1 
      1 /*	$NetBSD: spl.S,v 1.1 2001/07/28 13:28:04 chris Exp $	*/
      2 
      3 /*
      4  * Copyright (c) 1996-1998 Mark Brinicombe.
      5  * Copyright (c) Brini.
      6  * All rights reserved.
      7  *
      8  * Redistribution and use in source and binary forms, with or without
      9  * modification, are permitted provided that the following conditions
     10  * are met:
     11  * 1. Redistributions of source code must retain the above copyright
     12  *    notice, this list of conditions and the following disclaimer.
     13  * 2. Redistributions in binary form must reproduce the above copyright
     14  *    notice, this list of conditions and the following disclaimer in the
     15  *    documentation and/or other materials provided with the distribution.
     16  * 3. All advertising materials mentioning features or use of this software
     17  *    must display the following acknowledgement:
     18  *	This product includes software developed by Mark Brinicombe
     19  *	for the NetBSD Project.
     20  * 4. The name of the company nor the name of the author may be used to
     21  *    endorse or promote products derived from this software without specific
     22  *    prior written permission.
     23  *
     24  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR IMPLIED
     25  * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
     26  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     27  * IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT,
     28  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
     29  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
     30  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     31  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     32  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     33  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     34  * SUCH DAMAGE.
     35  *
     36  * spl routines
     37  *
     38  * Created      : 01/03/96
     39  */
     40 
     41 #include "assym.h"
     42 #include <machine/psl.h>
     43 #include <machine/asm.h>
     44 
     45 	.text
     46 	.align	0
     47 
     48 Lcurrent_spl_level:
     49 	.word	_C_LABEL(current_spl_level)
     50 
     51 Lspl_masks:
     52 	.word	_C_LABEL(spl_masks)
     53 
     54 Lspl_mask:
     55 	.word	_C_LABEL(spl_mask)
     56 
     57 ENTRY(raisespl)
     58 	mov	r3, r0			/* Save the new value */
     59 	ldr	r1, Lcurrent_spl_level	/* Get the current spl level */
     60 	ldr	r0, [r1]
     61 	cmp	r3, r0
     62 	movle	pc, lr
     63 
     64 	str	r3, [r1]		/* Store the new spl level */
     65 
     66 	ldr	r2, Lspl_masks		/* Get the spl mask */
     67 	ldr	r2, [r2, r3, lsl #2]
     68 
     69 	ldr	r1, Lspl_mask		/* Store in the current spl mask */
     70 	str	r2, [r1]
     71 
     72 	stmfd	sp!, {r0, lr}		/* Preserve registers */
     73 	bl	_C_LABEL(irq_setmasks)	/* Update the actual masks */
     74 	ldmfd	sp!, {r0, pc}		/* Exit */
     75 
     76 ENTRY(lowerspl)
     77 	mov	r3, r0			/* Save the new value */
     78 	ldr	r1, Lcurrent_spl_level	/* Get the current spl level */
     79 	ldr	r0, [r1]
     80 	cmp	r3, r0
     81 	movge	pc, lr
     82 
     83 	str	r3, [r1]		/* Store the new spl level */
     84 
     85 	ldr	r2, Lspl_masks		/* Get the spl mask */
     86 	ldr	r2, [r2, r3, lsl #2]
     87 
     88 	ldr	r1, Lspl_mask		/* Store in the current spl mask */
     89 	str	r2, [r1]
     90 
     91 	stmfd	sp!, {r0, lr}		/* Preserve registers */
     92 	bl	_C_LABEL(irq_setmasks)	/* Update the actual masks */
     93 	bl	_C_LABEL(dosoftints)	/* Process any pending soft ints */
     94 	ldmfd	sp!, {r0, pc}		/* Exit */
     95 
     96 ENTRY(splx)
     97 	mov	r3, r0			/* Save the new value */
     98 	ldr	r1, Lcurrent_spl_level	/* Get the current spl level */
     99 	ldr	r0, [r1]
    100 	cmp	r3, r0
    101 	moveq	pc, lr
    102 
    103 	str	r3, [r1]		/* Store the new spl level */
    104 
    105 	ldr	r2, Lspl_masks		/* Get the spl mask */
    106 	ldr	r2, [r2, r3, lsl #2]	/* Use r4 so available later */
    107 
    108 	ldr	r1, Lspl_mask		/* Store in the current spl mask */
    109 	str	r2, [r1]
    110 
    111 	stmfd	sp!, {r0, lr}		/* Preserve registers */
    112 	bl	_C_LABEL(irq_setmasks)	/* Update the actual masks */
    113 	bl	_C_LABEL(dosoftints)	/* Process any pending soft ints */
    114 	ldmfd	sp!, {r0, pc}		/* Exit */
    115