diff --git a/sys/arch/arm32/arm32/spl.S b/sys/arch/arm32/arm32/spl.S new file mode 100644 index 000000000000..9de9d09a0744 --- /dev/null +++ b/sys/arch/arm32/arm32/spl.S @@ -0,0 +1,126 @@ +/* $NetBSD: spl.S,v 1.1 1996/03/08 18:03:15 mark Exp $ */ + +/* + * Copyright (c) 1996 Mark Brinicombe. + * Copyright (c) Brini. + * All rights reserved. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. All advertising materials mentioning features or use of this software + * must display the following acknowledgement: + * This product includes software developed by Brini. + * 4. The name of the company nor the name of the author may be used to + * endorse or promote products derived from this software without specific + * prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY BRINI ``AS IS'' AND ANY EXPRESS OR IMPLIED + * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF + * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. + * IN NO EVENT SHALL BRINI OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, + * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES + * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR + * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + * + * RiscBSD kernel project + * + * splasm.S + * + * spl routines + * + * Created : 01/03/96 + * + * $Id: spl.S,v 1.1 1996/03/08 18:03:15 mark Exp $ + */ + +#include "assym.h" +#include + +sp .req r13 +lr .req r14 +pc .req r15 + + .text + .align 0 + +Lcurrent_spl_level: + .word _current_spl_level + +Lspl_masks: + .word _spl_masks + +Lspl_mask: + .word _spl_mask + + .global _raisespl +_raisespl: + mov r3, r0 /* Save the new value */ + ldr r1, Lcurrent_spl_level /* Get the current spl level */ + ldr r0, [r1] + cmp r3, r0 + movle pc, lr + + str r3, [r1] /* Store the new spl mask */ + + ldr r2, Lspl_masks /* Get the spl mask */ + ldr r2, [r2, r3, lsl #2] + + ldr r1, Lspl_mask /* Store in the current spl mask */ + str r2, [r1] + + stmfd sp!, {r0, lr} /* Preserve registers */ + bl _irq_setmasks /* Update the actual masks */ + ldmfd sp!, {r0, pc} /* Exit */ + + + .global _lowerspl +_lowerspl: + mov r3, r0 /* Save the new value */ + ldr r1, Lcurrent_spl_level /* Get the current spl level */ + ldr r0, [r1] + cmp r3, r0 + movge pc, lr + + str r3, [r1] /* Store the new spl mask */ + + ldr r2, Lspl_masks /* Get the spl mask */ + ldr r2, [r2, r3, lsl #2] + + ldr r1, Lspl_mask /* Store in the current spl mask */ + str r2, [r1] + + stmfd sp!, {r0, lr} /* Preserve registers */ + bl _irq_setmasks /* Update the actual masks */ + ldmfd sp!, {r0, pc} /* Exit */ + + + .global _splx +_splx: + mov r3, r0 /* Save the new value */ + ldr r1, Lcurrent_spl_level /* Get the current spl level */ + ldr r0, [r1] + cmp r3, r0 + moveq pc, lr + + str r3, [r1] /* Store the new spl mask */ + + ldr r2, Lspl_masks /* Get the spl mask */ + ldr r2, [r2, r3, lsl #2] + + ldr r1, Lspl_mask /* Store in the current spl mask */ + str r2, [r1] + + stmfd sp!, {r0, lr} /* Preserve registers */ + bl _irq_setmasks /* Update the actual masks */ + ldmfd sp!, {r0, pc} /* Exit */ +