Commit of the new assembly spl functions splx(), raisespl() and

lowerspl() to go with the new spl macros in psl.h

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 <machine/psl.h>
+
+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 */
+