#ifndef _ARM_CPUFUNC_H_
#define _ARM_CPUFUNC_H_
#ifdef _ARM_ARCH_7
#define dsb(opt) __asm __volatile("dsb " __STRING(opt) : : : "memory")
#define dmb(opt) __asm __volatile("dmb " __STRING(opt) : : : "memory")
#define isb() __asm __volatile("isb" : : : "memory")
#define sev() __asm __volatile("sev" : : : "memory")
#else
#define dsb(opt) \
__asm __volatile("mcr p15, 0, %0, c7, c10, 4" :: "r" (0) : "memory")
#define dmb(opt) \
__asm __volatile("mcr p15, 0, %0, c7, c10, 5" :: "r" (0) : "memory")
#define isb() \
__asm __volatile("mcr p15, 0, %0, c7, c5, 4" :: "r" (0) : "memory")
#define sev() __nothing
#endif
#if defined(_ARM_ARCH_8)
#define dma_r_r() dmb(oshld)
#define dma_w_w() dmb(oshst)
#define dma_rw_w() dmb(osh)
#elif defined(_ARM_ARCH_6)
#define dma_r_r() dmb(osh)
#define dma_w_w() dmb(oshst)
#define dma_rw_w() dmb(osh)
#else
#define dma_r_r() __nothing
#define dma_w_w() cpu_drain_writebuf()
#define dma_rw_w() cpu_drain_writebuf()
#endif
#ifdef __arm__
#ifdef _KERNEL
#include <sys/types.h>
#include <arm/armreg.h>
#include <arm/cpuconf.h>
#include <arm/cpufunc_proto.h>
struct cpu_functions {
u_int (*cf_id) (void);
void (*cf_cpwait) (void);
u_int (*cf_control) (u_int, u_int);
void (*cf_domains) (u_int);
#if defined(ARM_MMU_EXTENDED)
void (*cf_setttb) (u_int, tlb_asid_t);
#else
void (*cf_setttb) (u_int, bool);
#endif
u_int (*cf_faultstatus) (void);
u_int (*cf_faultaddress) (void);
void (*cf_tlb_flushID) (void);
void (*cf_tlb_flushID_SE) (vaddr_t);
void (*cf_tlb_flushI) (void);
void (*cf_tlb_flushI_SE) (vaddr_t);
void (*cf_tlb_flushD) (void);
void (*cf_tlb_flushD_SE) (vaddr_t);
void (*cf_icache_sync_all) (void);
void (*cf_icache_sync_range) (vaddr_t, vsize_t);
void (*cf_dcache_wbinv_all) (void);
void (*cf_dcache_wbinv_range)(vaddr_t, vsize_t);
void (*cf_dcache_inv_range) (vaddr_t, vsize_t);
void (*cf_dcache_wb_range) (vaddr_t, vsize_t);
void (*cf_sdcache_wbinv_range)(vaddr_t, paddr_t, psize_t);
void (*cf_sdcache_inv_range) (vaddr_t, paddr_t, psize_t);
void (*cf_sdcache_wb_range) (vaddr_t, paddr_t, psize_t);
void (*cf_idcache_wbinv_all) (void);
void (*cf_idcache_wbinv_range)(vaddr_t, vsize_t);
void (*cf_flush_prefetchbuf) (void);
void (*cf_drain_writebuf) (void);
void (*cf_flush_brnchtgt_C) (void);
void (*cf_flush_brnchtgt_E) (u_int);
void (*cf_sleep) (int mode);
int (*cf_dataabt_fixup) (void *);
int (*cf_prefetchabt_fixup) (void *);
#if defined(ARM_MMU_EXTENDED)
void (*cf_context_switch) (u_int, tlb_asid_t);
#else
void (*cf_context_switch) (u_int);
#endif
void (*cf_setup) (char *);
};
extern struct cpu_functions cpufuncs;
extern u_int cputype;
#define cpu_idnum() cpufuncs.cf_id()
#define cpu_control(c, e) cpufuncs.cf_control(c, e)
#define cpu_domains(d) cpufuncs.cf_domains(d)
#define cpu_setttb(t, f) cpufuncs.cf_setttb(t, f)
#define cpu_faultstatus() cpufuncs.cf_faultstatus()
#define cpu_faultaddress() cpufuncs.cf_faultaddress()
#define cpu_tlb_flushID() cpufuncs.cf_tlb_flushID()
#define cpu_tlb_flushID_SE(e) cpufuncs.cf_tlb_flushID_SE(e)
#define cpu_tlb_flushI() cpufuncs.cf_tlb_flushI()
#define cpu_tlb_flushI_SE(e) cpufuncs.cf_tlb_flushI_SE(e)
#define cpu_tlb_flushD() cpufuncs.cf_tlb_flushD()
#define cpu_tlb_flushD_SE(e) cpufuncs.cf_tlb_flushD_SE(e)
#define cpu_icache_sync_all() cpufuncs.cf_icache_sync_all()
#define cpu_icache_sync_range(a, s) cpufuncs.cf_icache_sync_range((a), (s))
#define cpu_dcache_wbinv_all() cpufuncs.cf_dcache_wbinv_all()
#define cpu_dcache_wbinv_range(a, s) cpufuncs.cf_dcache_wbinv_range((a), (s))
#define cpu_dcache_inv_range(a, s) cpufuncs.cf_dcache_inv_range((a), (s))
#define cpu_dcache_wb_range(a, s) cpufuncs.cf_dcache_wb_range((a), (s))
#define cpu_sdcache_wbinv_range(a, b, s) cpufuncs.cf_sdcache_wbinv_range((a), (b), (s))
#define cpu_sdcache_inv_range(a, b, s) cpufuncs.cf_sdcache_inv_range((a), (b), (s))
#define cpu_sdcache_wb_range(a, b, s) cpufuncs.cf_sdcache_wb_range((a), (b), (s))
#define cpu_idcache_wbinv_all() cpufuncs.cf_idcache_wbinv_all()
#define cpu_idcache_wbinv_range(a, s) cpufuncs.cf_idcache_wbinv_range((a), (s))
#define cpu_flush_prefetchbuf() cpufuncs.cf_flush_prefetchbuf()
#define cpu_drain_writebuf() cpufuncs.cf_drain_writebuf()
#define cpu_flush_brnchtgt_C() cpufuncs.cf_flush_brnchtgt_C()
#define cpu_flush_brnchtgt_E(e) cpufuncs.cf_flush_brnchtgt_E(e)
#define cpu_sleep(m) cpufuncs.cf_sleep(m)
#define cpu_dataabt_fixup(a) cpufuncs.cf_dataabt_fixup(a)
#define cpu_prefetchabt_fixup(a) cpufuncs.cf_prefetchabt_fixup(a)
#define ABORT_FIXUP_OK 0
#define ABORT_FIXUP_FAILED 1
#define ABORT_FIXUP_RETURN 2
#define cpu_context_switch(a) cpufuncs.cf_context_switch(a)
#define cpu_setup(a) cpufuncs.cf_setup(a)
int set_cpufuncs (void);
int set_cpufuncs_id (u_int);
#define ARCHITECTURE_NOT_PRESENT 1
#define ARCHITECTURE_NOT_SUPPORTED 2
void cpufunc_nullop (void);
int cpufunc_null_fixup (void *);
int early_abort_fixup (void *);
int late_abort_fixup (void *);
u_int cpufunc_id (void);
u_int cpufunc_control (u_int, u_int);
void cpufunc_domains (u_int);
u_int cpufunc_faultstatus (void);
u_int cpufunc_faultaddress (void);
#if defined(CPU_XSCALE)
#define cpu_cpwait() cpufuncs.cf_cpwait()
#endif
#ifndef cpu_cpwait
#define cpu_cpwait()
#endif
static __inline uint32_t __set_cpsr_c(uint32_t bic, uint32_t eor) __attribute__((__unused__));
static __inline uint32_t disable_interrupts(uint32_t mask) __attribute__((__unused__));
static __inline uint32_t enable_interrupts(uint32_t mask) __attribute__((__unused__));
static __inline uint32_t
__set_cpsr_c(uint32_t bic, uint32_t eor)
{
uint32_t tmp, ret;
__asm volatile(
"mrs %0, cpsr\n"
"bic %1, %0, %2\n"
"eor %1, %1, %3\n"
"msr cpsr_c, %1\n"
: "=&r" (ret), "=&r" (tmp)
: "r" (bic), "r" (eor) : "memory");
return ret;
}
static __inline uint32_t
disable_interrupts(uint32_t mask)
{
uint32_t tmp, ret;
mask &= (I32_bit | F32_bit);
__asm volatile(
"mrs %0, cpsr\n"
"orr %1, %0, %2\n"
"msr cpsr_c, %1\n"
: "=&r" (ret), "=&r" (tmp)
: "r" (mask)
: "memory");
return ret;
}
static __inline uint32_t
enable_interrupts(uint32_t mask)
{
uint32_t ret;
mask &= (I32_bit | F32_bit);
__asm __volatile("mrs\t%0, cpsr\n" : "=r"(ret));
#ifdef _ARM_ARCH_6
if (__builtin_constant_p(mask)) {
switch (mask) {
case I32_bit | F32_bit:
__asm __volatile("cpsie\tif");
break;
case I32_bit:
__asm __volatile("cpsie\ti");
break;
case F32_bit:
__asm __volatile("cpsie\tf");
break;
default:
break;
}
return ret;
}
#endif
__asm volatile("msr\tcpsr_c, %0" :: "r"(ret & ~mask));
return ret;
}
#define restore_interrupts(old_cpsr) \
(__set_cpsr_c((I32_bit | F32_bit), (old_cpsr) & (I32_bit | F32_bit)))
#define ENABLE_INTERRUPT() cpsie(I32_bit)
#define DISABLE_INTERRUPT() cpsid(I32_bit)
#define DISABLE_INTERRUPT_SAVE() cpsid(I32_bit)
static inline void cpsie(register_t psw) __attribute__((__unused__));
static inline register_t cpsid(register_t psw) __attribute__((__unused__));
static inline void
cpsie(register_t psw)
{
#ifdef _ARM_ARCH_6
if (!__builtin_constant_p(psw)) {
enable_interrupts(psw);
return;
}
switch (psw & (I32_bit|F32_bit)) {
case I32_bit: __asm("cpsie\ti"); break;
case F32_bit: __asm("cpsie\tf"); break;
case I32_bit|F32_bit: __asm("cpsie\tif"); break;
}
#else
enable_interrupts(psw);
#endif
}
static inline register_t
cpsid(register_t psw)
{
#ifdef _ARM_ARCH_6
register_t oldpsw;
if (!__builtin_constant_p(psw))
return disable_interrupts(psw);
__asm("mrs %0, cpsr" : "=r"(oldpsw));
switch (psw & (I32_bit|F32_bit)) {
case I32_bit: __asm("cpsid\ti"); break;
case F32_bit: __asm("cpsid\tf"); break;
case I32_bit|F32_bit: __asm("cpsid\tif"); break;
}
return oldpsw;
#else
return disable_interrupts(psw);
#endif
}
u_int SetCPSR(u_int, u_int);
u_int GetCPSR(void);
void cpu_reset (void) __dead;
#if (ARM_MMU_V6 + ARM_MMU_V7) != 0
extern u_int arm_cache_prefer_mask;
#endif
extern u_int arm_dcache_align;
extern u_int arm_dcache_align_mask;
extern struct arm_cache_info arm_pcache;
extern struct arm_cache_info arm_scache;
extern uint32_t cpu_ttb;
#endif
#if defined(_KERNEL) || defined(_KMEMUSER)
int get_pc_str_offset(void);
bool cpu_gtmr_exists_p(void);
u_int cpu_clusterid(void);
bool cpu_earlydevice_va_p(void);
void set_stackptr (u_int, u_int);
u_int get_stackptr (u_int);
#endif
#elif defined(__aarch64__)
#include <aarch64/cpufunc.h>
#endif
#endif