spl.S revision 1.6
1/*	$NetBSD: spl.S,v 1.6 2007/10/17 19:53:31 garbled 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 <arm/arm32/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
51ENTRY(raisespl)
52	mov	r3, r0			/* Save the new value */
53	ldr	r1, .Lcurrent_spl_level	/* Get the current spl level */
54	ldr	r0, [r1]
55	cmp	r3, r0
56	movle	pc, lr
57
58	str	r3, [r1]		/* Store the new spl level */
59
60					/* stack alignment is 8 bytes */
61	stmfd	sp!, {r0, lr}		/* Preserve registers */
62	bl	_C_LABEL(irq_setmasks)	/* Update the actual masks */
63	ldmfd	sp!, {r0, pc}		/* Exit */
64
65ENTRY(lowerspl)
66	mov	r3, r0			/* Save the new value */
67	ldr	r1, .Lcurrent_spl_level	/* Get the current spl level */
68	ldr	r0, [r1]
69	cmp	r3, r0
70	movge	pc, lr
71
72	str	r3, [r1]		/* Store the new spl level */
73
74					/* stack alignment is 8 bytes */
75	stmfd	sp!, {r0, lr}		/* Preserve registers */
76	bl	_C_LABEL(irq_setmasks)	/* Update the actual masks */
77	bl	_C_LABEL(dosoftints)	/* Process any pending soft ints */
78	ldmfd	sp!, {r0, pc}		/* Exit */
79
80ENTRY(splx)
81	ldr	r1, .Lcurrent_spl_level	/* Get the current spl level */
82	mov	r3, r0			/* Save the new value */
83	ldr	r0, [r1]
84	cmp	r3, r0
85	moveq	pc, lr
86
87	str	r3, [r1]		/* Store the new spl level */
88
89					/* stack alignment is 8 bytes */
90	stmfd	sp!, {r0, lr}		/* Preserve registers */
91
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