locore.h revision 1.8 1 /* $NetBSD: locore.h,v 1.8 2021/02/20 19:27:35 jmcneill Exp $ */
2
3 /*-
4 * Copyright (c) 2014 The NetBSD Foundation, Inc.
5 * All rights reserved.
6 *
7 * This code is derived from software contributed to The NetBSD Foundation
8 * by Matt Thomas of 3am Software Foundry.
9 *
10 * Redistribution and use in source and binary forms, with or without
11 * modification, are permitted provided that the following conditions
12 * are met:
13 * 1. Redistributions of source code must retain the above copyright
14 * notice, this list of conditions and the following disclaimer.
15 * 2. Redistributions in binary form must reproduce the above copyright
16 * notice, this list of conditions and the following disclaimer in the
17 * documentation and/or other materials provided with the distribution.
18 *
19 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29 * POSSIBILITY OF SUCH DAMAGE.
30 */
31
32 #ifndef _AARCH64_LOCORE_H_
33 #define _AARCH64_LOCORE_H_
34
35 #ifdef __aarch64__
36
37 #ifdef _KERNEL_OPT
38 #include "opt_multiprocessor.h"
39 #endif
40
41 #ifdef _LOCORE
42
43 #define ENABLE_INTERRUPT \
44 msr daifclr, #((DAIF_I|DAIF_F) >> DAIF_SETCLR_SHIFT)
45 #define DISABLE_INTERRUPT \
46 msr daifset, #((DAIF_I|DAIF_F) >> DAIF_SETCLR_SHIFT)
47
48 #else /* _LOCORE */
49
50 #include <sys/types.h>
51
52 #include <aarch64/armreg.h>
53 #include <aarch64/machdep.h> /* arm32 compat */
54
55 /* for compatibility arch/arm */
56 #define I32_bit DAIF_I
57 #define F32_bit DAIF_F
58 #define cpsie(psw) daif_enable((psw))
59 #define cpsid(psw) daif_disable((psw))
60
61
62 #define ENABLE_INTERRUPT() \
63 reg_daifclr_write((DAIF_I|DAIF_F) >> DAIF_SETCLR_SHIFT)
64 #define DISABLE_INTERRUPT() \
65 reg_daifset_write((DAIF_I|DAIF_F) >> DAIF_SETCLR_SHIFT)
66
67 #define DAIF_MASK (DAIF_D|DAIF_A|DAIF_I|DAIF_F)
68
69 static inline void __unused
70 daif_enable(register_t psw)
71 {
72 if (!__builtin_constant_p(psw)) {
73 reg_daif_write(reg_daif_read() & ~psw);
74 } else {
75 reg_daifclr_write((psw & DAIF_MASK) >> DAIF_SETCLR_SHIFT);
76 }
77 }
78
79 static inline register_t __unused
80 daif_disable(register_t psw)
81 {
82 register_t oldpsw = reg_daif_read();
83 if ((oldpsw & psw) != psw) {
84 if (!__builtin_constant_p(psw)) {
85 reg_daif_write(oldpsw | psw);
86 } else {
87 reg_daifset_write((psw & DAIF_MASK) >> DAIF_SETCLR_SHIFT);
88 }
89 }
90 return oldpsw;
91 }
92
93 #endif /* _LOCORE */
94
95 #elif defined(__arm__)
96
97 #include <arm/locore.h>
98
99 #endif /* __aarch64__/__arm__ */
100
101 #endif /* _AARCH64_LOCORE_H_ */
102