locore.h revision 1.3 1 /* $NetBSD: locore.h,v 1.3 2018/04/01 04:35:03 ryo 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
54 #ifdef MULTIPROCESSOR
55 /* for compatibility arch/arm/pic/pic.c */
56 extern u_int arm_cpu_max;
57 #endif
58
59 /* for compatibility arch/arm */
60 #define I32_bit DAIF_I
61 #define F32_bit DAIF_F
62 #define cpsie(psw) daif_enable((psw))
63 #define cpsid(psw) daif_disable((psw))
64
65
66 #define ENABLE_INTERRUPT() daif_enable(DAIF_I|DAIF_F)
67 #define DISABLE_INTERRUPT() daif_disable(DAIF_I|DAIF_F)
68
69 #define DAIF_MASK (DAIF_D|DAIF_A|DAIF_I|DAIF_F)
70
71 static inline void __unused
72 daif_enable(register_t psw)
73 {
74 if (!__builtin_constant_p(psw)) {
75 reg_daif_write(reg_daif_read() & ~psw);
76 } else {
77 reg_daifclr_write((psw & DAIF_MASK) >> DAIF_SETCLR_SHIFT);
78 }
79 }
80
81 static inline register_t __unused
82 daif_disable(register_t psw)
83 {
84 register_t oldpsw = reg_daif_read();
85 if (!__builtin_constant_p(psw)) {
86 reg_daif_write(oldpsw | psw);
87 } else {
88 reg_daifset_write((psw & DAIF_MASK) >> DAIF_SETCLR_SHIFT);
89 }
90 return oldpsw;
91 }
92
93 static inline void
94 arm_dsb(void)
95 {
96 __asm __volatile("dsb sy" ::: "memory");
97 }
98
99 static inline void
100 arm_isb(void)
101 {
102 __asm __volatile("isb" ::: "memory");
103 }
104
105 #endif /* _LOCORE */
106
107 #elif defined(__arm__)
108
109 #include <arm/locore.h>
110
111 #endif /* __aarch64__/__arm__ */
112
113 #endif /* _AARCH64_LOCORE_H_ */
114