spl.S revision 1.7 1 /* $NetBSD: spl.S,v 1.7 2007/12/03 15:33:16 ad 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
51 ENTRY(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
65 ENTRY(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 #ifdef __HAVE_FAST_SOFTINTS
78 bl _C_LABEL(dosoftints) /* Process any pending soft ints */
79 #endif
80 ldmfd sp!, {r0, pc} /* Exit */
81
82 ENTRY(splx)
83 ldr r1, .Lcurrent_spl_level /* Get the current spl level */
84 mov r3, r0 /* Save the new value */
85 ldr r0, [r1]
86 cmp r3, r0
87 moveq pc, lr
88
89 str r3, [r1] /* Store the new spl level */
90
91 /* stack alignment is 8 bytes */
92 stmfd sp!, {r0, lr} /* Preserve registers */
93
94 bl _C_LABEL(irq_setmasks) /* Update the actual masks */
95 #ifdef __HAVE_FAST_SOFTINTS
96 bl _C_LABEL(dosoftints) /* Process any pending soft ints */
97 #endif
98 ldmfd sp!, {r0, pc} /* Exit */
99