sys/arm64/include/cpufunc.h

   1 /*-
   2  * Copyright (c) 2014 Andrew Turner
   3  * All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions
   7  * are met:
   8  * 1. Redistributions of source code must retain the above copyright
   9  *    notice, this list of conditions and the following disclaimer.
  10  * 2. Redistributions in binary form must reproduce the above copyright
  11  *    notice, this list of conditions and the following disclaimer in the
  12  *    documentation and/or other materials provided with the distribution.
  13  *
  14  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
  15  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  16  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  17  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
  18  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  19  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  20  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  21  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  22  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  23  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  24  * SUCH DAMAGE.
  25  *
  26  * $FreeBSD$
  27  */
  28
  29 #ifndef _MACHINE_CPUFUNC_H_
  30 #define _MACHINE_CPUFUNC_H_
  31
  32 static __inline void
  33 breakpoint(void)
  34 {
  35
  36         __asm("brk #0");
  37 }
  38
  39 #ifdef _KERNEL
  40
  41 #define HAVE_INLINE_FFS
  42
  43 static __inline __pure2 int
  44 ffs(int mask)
  45 {
  46
  47         return (__builtin_ffs(mask));
  48 }
  49
  50 #define HAVE_INLINE_FFSL
  51
  52 static __inline __pure2 int
  53 ffsl(long mask)
  54 {
  55
  56         return (__builtin_ffsl(mask));
  57 }
  58
  59 #define HAVE_INLINE_FFSLL
  60
  61 static __inline __pure2 int
  62 ffsll(long long mask)
  63 {
  64
  65         return (__builtin_ffsll(mask));
  66 }
  67
  68 #define HAVE_INLINE_FLS
  69
  70 static __inline __pure2 int
  71 fls(int mask)
  72 {
  73
  74         return (mask == 0 ? 0 :
  75             8 * sizeof(mask) - __builtin_clz((u_int)mask));
  76 }
  77
  78 #define HAVE_INLINE_FLSL
  79
  80 static __inline __pure2 int
  81 flsl(long mask)
  82 {
  83
  84         return (mask == 0 ? 0 :
  85             8 * sizeof(mask) - __builtin_clzl((u_long)mask));
  86 }
  87
  88 #define HAVE_INLINE_FLSLL
  89
  90 static __inline __pure2 int
  91 flsll(long long mask)
  92 {
  93
  94         return (mask == 0 ? 0 :
  95             8 * sizeof(mask) - __builtin_clzll((unsigned long long)mask));
  96 }
  97
  98 #include <machine/armreg.h>
  99
 100 void pan_enable(void);
 101
 102 static __inline register_t
 103 dbg_disable(void)
 104 {
 105         uint32_t ret;
 106
 107         __asm __volatile(
 108             "mrs %x0, daif   \n"
 109             "msr daifset, #(" __XSTRING(DAIF_D) ") \n"
 110             : "=&r" (ret));
 111
 112         return (ret);
 113 }
 114
 115 static __inline void
 116 dbg_enable(void)
 117 {
 118
 119         __asm __volatile("msr daifclr, #(" __XSTRING(DAIF_D) ")");
 120 }
 121
 122 static __inline register_t
 123 intr_disable(void)
 124 {
 125         /* DAIF is a 32-bit register */
 126         uint32_t ret;
 127
 128         __asm __volatile(
 129             "mrs %x0, daif   \n"
 130             "msr daifset, #(" __XSTRING(DAIF_INTR) ") \n"
 131             : "=&r" (ret));
 132
 133         return (ret);
 134 }
 135
 136 static __inline void
 137 intr_restore(register_t s)
 138 {
 139
 140         WRITE_SPECIALREG(daif, s);
 141 }
 142
 143 static __inline void
 144 intr_enable(void)
 145 {
 146
 147         __asm __volatile("msr daifclr, #(" __XSTRING(DAIF_INTR) ")");
 148 }
 149
 150 static __inline void
 151 serror_enable(void)
 152 {
 153
 154         __asm __volatile("msr daifclr, #(" __XSTRING(DAIF_A) ")");
 155 }
 156
 157 static __inline register_t
 158 get_midr(void)
 159 {
 160         uint64_t midr;
 161
 162         midr = READ_SPECIALREG(midr_el1);
 163
 164         return (midr);
 165 }
 166
 167 static __inline register_t
 168 get_mpidr(void)
 169 {
 170         uint64_t mpidr;
 171
 172         mpidr = READ_SPECIALREG(mpidr_el1);
 173
 174         return (mpidr);
 175 }
 176
 177 static __inline void
 178 clrex(void)
 179 {
 180
 181         /*
 182          * Ensure compiler barrier, otherwise the monitor clear might
 183          * occur too late for us ?
 184          */
 185         __asm __volatile("clrex" : : : "memory");
 186 }
 187
 188 static __inline void
 189 set_ttbr0(uint64_t ttbr0)
 190 {
 191
 192         __asm __volatile(
 193             "msr ttbr0_el1, %0 \n"
 194             "isb               \n"
 195             :
 196             : "r" (ttbr0));
 197 }
 198
 199 static __inline void
 200 invalidate_icache(void)
 201 {
 202
 203         __asm __volatile(
 204             "ic ialluis        \n"
 205             "dsb ish           \n"
 206             "isb               \n");
 207 }
 208
 209 static __inline void
 210 invalidate_local_icache(void)
 211 {
 212
 213         __asm __volatile(
 214             "ic iallu          \n"
 215             "dsb nsh           \n"
 216             "isb               \n");
 217 }
 218
 219 extern bool icache_aliasing;
 220 extern bool icache_vmid;
 221
 222 extern int64_t dcache_line_size;
 223 extern int64_t icache_line_size;
 224 extern int64_t idcache_line_size;
 225 extern int64_t dczva_line_size;
 226
 227 #define cpu_nullop()                    arm64_nullop()
 228 #define cpufunc_nullop()                arm64_nullop()
 229
 230 #define cpu_tlb_flushID()               arm64_tlb_flushID()
 231
 232 #define cpu_dcache_wbinv_range(a, s)    arm64_dcache_wbinv_range((a), (s))
 233 #define cpu_dcache_inv_range(a, s)      arm64_dcache_inv_range((a), (s))
 234 #define cpu_dcache_wb_range(a, s)       arm64_dcache_wb_range((a), (s))
 235
 236 extern void (*arm64_icache_sync_range)(vm_offset_t, vm_size_t);
 237
 238 #define cpu_icache_sync_range(a, s)     arm64_icache_sync_range((a), (s))
 239 #define cpu_icache_sync_range_checked(a, s) arm64_icache_sync_range_checked((a), (s))
 240
 241 void arm64_nullop(void);
 242 void arm64_tlb_flushID(void);
 243 void arm64_dic_idc_icache_sync_range(vm_offset_t, vm_size_t);
 244 void arm64_aliasing_icache_sync_range(vm_offset_t, vm_size_t);
 245 int arm64_icache_sync_range_checked(vm_offset_t, vm_size_t);
 246 void arm64_dcache_wbinv_range(vm_offset_t, vm_size_t);
 247 void arm64_dcache_inv_range(vm_offset_t, vm_size_t);
 248 void arm64_dcache_wb_range(vm_offset_t, vm_size_t);
 249 bool arm64_get_writable_addr(vm_offset_t, vm_offset_t *);
 250
 251 #endif  /* _KERNEL */
 252 #endif  /* _MACHINE_CPUFUNC_H_ */