#ifndef _CPU_CPUFUNC_H_
#define _CPU_CPUFUNC_H_
#include <sys/cdefs.h>
#include <sys/thread.h>
#include <machine/clock.h>
#include <machine/psl.h>
#include <machine/smp.h>
struct thread;
struct region_descriptor;
struct pmap;
__BEGIN_DECLS
#define readb(va) (*(volatile u_int8_t *) (va))
#define readw(va) (*(volatile u_int16_t *) (va))
#define readl(va) (*(volatile u_int32_t *) (va))
#define readq(va) (*(volatile u_int64_t *) (va))
#define writeb(va, d) (*(volatile u_int8_t *) (va) = (d))
#define writew(va, d) (*(volatile u_int16_t *) (va) = (d))
#define writel(va, d) (*(volatile u_int32_t *) (va) = (d))
#define writeq(va, d) (*(volatile u_int64_t *) (va) = (d))
#ifdef __GNUC__
#include <machine/lock.h>
struct trapframe;
static __inline void
breakpoint(void)
{
__asm __volatile("int $3");
}
static __inline void
cpu_pause(void)
{
__asm __volatile("pause":::"memory");
}
static __inline u_int
bsfl(u_int mask)
{
u_int result;
__asm __volatile("bsfl %1,%0" : "=r" (result) : "rm" (mask));
return (result);
}
static __inline u_long
bsfq(u_long mask)
{
u_long result;
__asm __volatile("bsfq %1,%0" : "=r" (result) : "rm" (mask));
return (result);
}
static __inline u_long
bsflong(u_long mask)
{
u_long result;
__asm __volatile("bsfq %1,%0" : "=r" (result) : "rm" (mask));
return (result);
}
static __inline u_int
bsrl(u_int mask)
{
u_int result;
__asm __volatile("bsrl %1,%0" : "=r" (result) : "rm" (mask));
return (result);
}
static __inline u_long
bsrq(u_long mask)
{
u_long result;
__asm __volatile("bsrq %1,%0" : "=r" (result) : "rm" (mask));
return (result);
}
static __inline void
clflush(u_long addr)
{
__asm __volatile("clflush %0" : : "m" (*(char *) addr));
}
static __inline void
clts(void)
{
__asm __volatile("clts");
}
static __inline void
cpuid_count(u_int ax, u_int cx, u_int *p)
{
__asm __volatile("cpuid"
: "=a" (p[0]), "=b" (p[1]), "=c" (p[2]), "=d" (p[3])
: "0" (ax), "c" (cx));
}
static __inline void
do_cpuid(u_int ax, u_int *p)
{
cpuid_count(ax, 0, p);
}
#ifndef _CPU_DISABLE_INTR_DEFINED
static __inline void
cpu_disable_intr(void)
{
__asm __volatile("cli" : : : "memory");
}
#endif
#ifndef _CPU_ENABLE_INTR_DEFINED
static __inline void
cpu_enable_intr(void)
{
__asm __volatile("sti");
}
#endif
static __inline void
cpu_mfence(void)
{
__asm __volatile("mfence" : : : "memory");
}
static __inline void
cpu_lfence(void)
{
__asm __volatile("lfence" : : : "memory");
}
static __inline void
cpu_sfence(void)
{
__asm __volatile("" : : : "memory");
}
static __inline void
cpu_ccfence(void)
{
__asm __volatile("" : : : "memory");
}
#define __AMDCPUBUG_DFLY01_AVAILABLE__
static __inline void
cpu_amdcpubug_dfly01(void)
{
__asm __volatile("nop" : : : "memory");
}
#ifdef _KERNEL
#define HAVE_INLINE_FFS
static __inline int
ffs(int mask)
{
return (__builtin_ffs(mask));
}
#define HAVE_INLINE_FFSL
static __inline int
ffsl(long mask)
{
return (__builtin_ffsl(mask));
}
#define HAVE_INLINE_FLS
static __inline int
fls(int mask)
{
return (mask == 0 ? mask : (int)bsrl((u_int)mask) + 1);
}
#define HAVE_INLINE_FLSL
static __inline int
flsl(long mask)
{
return (mask == 0 ? mask : (int)bsrq((u_long)mask) + 1);
}
#define HAVE_INLINE_FLSLL
static __inline int
flsll(long long mask)
{
return (flsl((long)mask));
}
#endif
static __inline void
halt(void)
{
__asm __volatile("hlt");
}
#define inb(port) __extension__ ({ \
u_char _data; \
if (__builtin_constant_p(port) && ((port) & 0xffff) < 0x100 \
&& (port) < 0x10000) \
_data = inbc(port); \
else \
_data = inbv(port); \
_data; })
#define outb(port, data) ( \
__builtin_constant_p(port) && ((port) & 0xffff) < 0x100 \
&& (port) < 0x10000 \
? outbc(port, data) : outbv(port, data))
static __inline u_char
inbc(u_int port)
{
u_char data;
__asm __volatile("inb %1,%0" : "=a" (data) : "id" ((u_short)(port)));
return (data);
}
static __inline void
outbc(u_int port, u_char data)
{
__asm __volatile("outb %0,%1" : : "a" (data), "id" ((u_short)(port)));
}
static __inline u_char
inbv(u_int port)
{
u_char data;
__asm __volatile("inb %%dx,%0" : "=a" (data) : "d" (port));
return (data);
}
static __inline u_int
inl(u_int port)
{
u_int data;
__asm __volatile("inl %%dx,%0" : "=a" (data) : "d" (port));
return (data);
}
static __inline void
insb(u_int port, void *addr, size_t cnt)
{
__asm __volatile("cld; rep; insb"
: "+D" (addr), "+c" (cnt)
: "d" (port)
: "memory");
}
static __inline void
insw(u_int port, void *addr, size_t cnt)
{
__asm __volatile("cld; rep; insw"
: "+D" (addr), "+c" (cnt)
: "d" (port)
: "memory");
}
static __inline void
insl(u_int port, void *addr, size_t cnt)
{
__asm __volatile("cld; rep; insl"
: "+D" (addr), "+c" (cnt)
: "d" (port)
: "memory");
}
static __inline void
invd(void)
{
__asm __volatile("invd");
}
#ifdef _KERNEL
#ifndef _CPU_INVLPG_DEFINED
static __inline void
cpu_invlpg(void *addr)
{
__asm __volatile("invlpg %0" : : "m" (*(char *)addr) : "memory");
}
#endif
static __inline void
cpu_nop(void)
{
__asm __volatile("rep; nop");
}
#endif
static __inline u_short
inw(u_int port)
{
u_short data;
__asm __volatile("inw %%dx,%0" : "=a" (data) : "d" (port));
return (data);
}
static __inline u_int
loadandclear(volatile u_int *addr)
{
u_int result;
__asm __volatile("xorl %0,%0; xchgl %1,%0"
: "=&r" (result) : "m" (*addr));
return (result);
}
static __inline void
outbv(u_int port, u_char data)
{
u_char al;
al = data;
__asm __volatile("outb %0,%%dx" : : "a" (al), "d" (port));
}
static __inline void
outl(u_int port, u_int data)
{
__asm __volatile("outl %0,%%dx" : : "a" (data), "d" (port));
}
static __inline void
outsb(u_int port, const void *addr, size_t cnt)
{
__asm __volatile("cld; rep; outsb"
: "+S" (addr), "+c" (cnt)
: "d" (port));
}
static __inline void
outsw(u_int port, const void *addr, size_t cnt)
{
__asm __volatile("cld; rep; outsw"
: "+S" (addr), "+c" (cnt)
: "d" (port));
}
static __inline void
outsl(u_int port, const void *addr, size_t cnt)
{
__asm __volatile("cld; rep; outsl"
: "+S" (addr), "+c" (cnt)
: "d" (port));
}
static __inline void
outw(u_int port, u_short data)
{
__asm __volatile("outw %0,%%dx" : : "a" (data), "d" (port));
}
static __inline void
ia32_pause(void)
{
__asm __volatile("pause");
}
static __inline u_long
read_rflags(void)
{
u_long rf;
__asm __volatile("pushfq; popq %0" : "=r" (rf));
return (rf);
}
static __inline u_int64_t
rdmsr(u_int msr)
{
u_int32_t low, high;
__asm __volatile("rdmsr" : "=a" (low), "=d" (high) : "c" (msr));
return (low | ((u_int64_t)high << 32));
}
static __inline u_int64_t
rdpmc(u_int pmc)
{
u_int32_t low, high;
__asm __volatile("rdpmc" : "=a" (low), "=d" (high) : "c" (pmc));
return (low | ((u_int64_t)high << 32));
}
#define _RDTSC_SUPPORTED_
static __inline tsc_uclock_t
rdtsc(void)
{
u_int32_t low, high;
__asm __volatile("rdtsc" : "=a" (low), "=d" (high));
return (low | ((tsc_uclock_t)high << 32));
}
#ifdef _KERNEL
#include <machine/cputypes.h>
#include <machine/md_var.h>
static __inline tsc_uclock_t
rdtsc_ordered(void)
{
if (cpu_vendor_id == CPU_VENDOR_INTEL)
cpu_lfence();
else
cpu_mfence();
return rdtsc();
}
#endif
static __inline void
wbinvd(void)
{
__asm __volatile("wbinvd");
}
#if defined(_KERNEL)
void cpu_wbinvd_on_all_cpus_callback(void *arg);
static __inline void
cpu_wbinvd_on_all_cpus(void)
{
lwkt_cpusync_simple(smp_active_mask, cpu_wbinvd_on_all_cpus_callback, NULL);
}
#endif
static __inline void
write_rflags(u_long rf)
{
__asm __volatile("pushq %0; popfq" : : "r" (rf));
}
static __inline void
wrmsr(u_int msr, u_int64_t newval)
{
u_int32_t low, high;
low = newval;
high = newval >> 32;
__asm __volatile("wrmsr"
:
: "a" (low), "d" (high), "c" (msr)
: "memory");
}
static __inline void
load_xcr(u_int xcr, uint64_t newval)
{
uint32_t low, high;
low = newval;
high = newval >> 32;
__asm __volatile("xsetbv"
:
: "a" (low), "d" (high), "c" (xcr)
: "memory");
}
static __inline uint64_t
rxcr(u_int xcr)
{
uint32_t low, high;
__asm __volatile("xgetbv" : "=a" (low), "=d" (high) : "c" (xcr));
return (low | ((uint64_t)high << 32));
}
static __inline void
load_cr0(u_long data)
{
__asm __volatile("movq %0,%%cr0" : : "r" (data) : "memory");
}
static __inline u_long
rcr0(void)
{
u_long data;
__asm __volatile("movq %%cr0,%0" : "=r" (data));
return (data);
}
static __inline void
load_cr2(u_long data)
{
__asm __volatile("movq %0,%%cr2" : : "r" (data) : "memory");
}
static __inline u_long
rcr2(void)
{
u_long data;
__asm __volatile("movq %%cr2,%0" : "=r" (data));
return (data);
}
static __inline void
load_cr3(u_long data)
{
__asm __volatile("movq %0,%%cr3" : : "r" (data) : "memory");
}
static __inline u_long
rcr3(void)
{
u_long data;
__asm __volatile("movq %%cr3,%0" : "=r" (data));
return (data);
}
static __inline void
load_cr4(u_long data)
{
__asm __volatile("movq %0,%%cr4" : : "r" (data) : "memory");
}
static __inline u_long
rcr4(void)
{
u_long data;
__asm __volatile("movq %%cr4,%0" : "=r" (data));
return (data);
}
#ifndef _CPU_INVLTLB_DEFINED
static __inline void
cpu_invltlb(void)
{
load_cr3(rcr3());
#if defined(SWTCH_OPTIM_STATS)
++tlb_flush_count;
#endif
}
#endif
void smp_invltlb(void);
void smp_sniff(void);
void cpu_sniff(int);
void hard_sniff(struct trapframe *);
static __inline u_short
rfs(void)
{
u_short sel;
__asm __volatile("movw %%fs,%0" : "=rm" (sel));
return (sel);
}
static __inline u_short
rgs(void)
{
u_short sel;
__asm __volatile("movw %%gs,%0" : "=rm" (sel));
return (sel);
}
static __inline void
load_ds(u_short sel)
{
__asm __volatile("movw %0,%%ds" : : "rm" (sel));
}
static __inline void
load_es(u_short sel)
{
__asm __volatile("movw %0,%%es" : : "rm" (sel));
}
#ifdef _KERNEL
#ifndef MSR_FSBASE
#define MSR_FSBASE 0xc0000100
#endif
static __inline void
load_fs(u_short sel)
{
__asm __volatile("rdmsr; movw %0,%%fs; wrmsr"
: : "rm" (sel), "c" (MSR_FSBASE) : "eax", "edx");
}
#ifndef MSR_GSBASE
#define MSR_GSBASE 0xc0000101
#endif
static __inline void
load_gs(u_short sel)
{
__asm __volatile("pushfq; cli; rdmsr; movw %0,%%gs; wrmsr; popfq"
: : "rm" (sel), "c" (MSR_GSBASE) : "eax", "edx");
}
#else
static __inline void
load_fs(u_short sel)
{
__asm __volatile("movw %0,%%fs" : : "rm" (sel));
}
static __inline void
load_gs(u_short sel)
{
__asm __volatile("movw %0,%%gs" : : "rm" (sel));
}
#endif
static __inline void
lidt(struct region_descriptor *addr)
{
__asm __volatile("lidt (%0)" : : "r" (addr));
}
static __inline void
lldt(u_short sel)
{
__asm __volatile("lldt %0" : : "r" (sel));
}
static __inline void
ltr(u_short sel)
{
__asm __volatile("ltr %0" : : "r" (sel));
}
static __inline u_int64_t
rdr0(void)
{
u_int64_t data;
__asm __volatile("movq %%dr0,%0" : "=r" (data));
return (data);
}
static __inline void
load_dr0(u_int64_t dr0)
{
__asm __volatile("movq %0,%%dr0" : : "r" (dr0) : "memory");
}
static __inline u_int64_t
rdr1(void)
{
u_int64_t data;
__asm __volatile("movq %%dr1,%0" : "=r" (data));
return (data);
}
static __inline void
load_dr1(u_int64_t dr1)
{
__asm __volatile("movq %0,%%dr1" : : "r" (dr1) : "memory");
}
static __inline u_int64_t
rdr2(void)
{
u_int64_t data;
__asm __volatile("movq %%dr2,%0" : "=r" (data));
return (data);
}
static __inline void
load_dr2(u_int64_t dr2)
{
__asm __volatile("movq %0,%%dr2" : : "r" (dr2) : "memory");
}
static __inline u_int64_t
rdr3(void)
{
u_int64_t data;
__asm __volatile("movq %%dr3,%0" : "=r" (data));
return (data);
}
static __inline void
load_dr3(u_int64_t dr3)
{
__asm __volatile("movq %0,%%dr3" : : "r" (dr3) : "memory");
}
static __inline u_int64_t
rdr4(void)
{
u_int64_t data;
__asm __volatile("movq %%dr4,%0" : "=r" (data));
return (data);
}
static __inline void
load_dr4(u_int64_t dr4)
{
__asm __volatile("movq %0,%%dr4" : : "r" (dr4) : "memory");
}
static __inline u_int64_t
rdr5(void)
{
u_int64_t data;
__asm __volatile("movq %%dr5,%0" : "=r" (data));
return (data);
}
static __inline void
load_dr5(u_int64_t dr5)
{
__asm __volatile("movq %0,%%dr5" : : "r" (dr5) : "memory");
}
static __inline u_int64_t
rdr6(void)
{
u_int64_t data;
__asm __volatile("movq %%dr6,%0" : "=r" (data));
return (data);
}
static __inline void
load_dr6(u_int64_t dr6)
{
__asm __volatile("movq %0,%%dr6" : : "r" (dr6) : "memory");
}
static __inline u_int64_t
rdr7(void)
{
u_int64_t data;
__asm __volatile("movq %%dr7,%0" : "=r" (data));
return (data);
}
static __inline void
load_dr7(u_int64_t dr7)
{
__asm __volatile("movq %0,%%dr7" : : "r" (dr7) : "memory");
}
static __inline register_t
intr_disable(void)
{
register_t rflags;
rflags = read_rflags();
cpu_disable_intr();
return (rflags);
}
static __inline void
intr_restore(register_t rflags)
{
write_rflags(rflags);
}
#else
int breakpoint(void);
void cpu_pause(void);
u_int bsfl(u_int mask);
u_int bsrl(u_int mask);
void cpu_disable_intr(void);
void cpu_enable_intr(void);
void cpu_invlpg(u_long addr);
void cpu_invlpg_range(u_long start, u_long end);
void do_cpuid(u_int ax, u_int *p);
void halt(void);
u_char inb(u_int port);
u_int inl(u_int port);
void insb(u_int port, void *addr, size_t cnt);
void insl(u_int port, void *addr, size_t cnt);
void insw(u_int port, void *addr, size_t cnt);
void invd(void);
void invlpg_range(u_int start, u_int end);
void cpu_invltlb(void);
u_short inw(u_int port);
void load_cr0(u_int cr0);
void load_cr2(u_int cr2);
void load_cr3(u_int cr3);
void load_cr4(u_int cr4);
void load_fs(u_int sel);
void load_gs(u_int sel);
void lidt(struct region_descriptor *addr);
void lldt(u_short sel);
void ltr(u_short sel);
void outb(u_int port, u_char data);
void outl(u_int port, u_int data);
void outsb(u_int port, void *addr, size_t cnt);
void outsl(u_int port, void *addr, size_t cnt);
void outsw(u_int port, void *addr, size_t cnt);
void outw(u_int port, u_short data);
void ia32_pause(void);
u_int rcr0(void);
u_int rcr2(void);
u_int rcr3(void);
u_int rcr4(void);
u_short rfs(void);
u_short rgs(void);
u_int64_t rdmsr(u_int msr);
u_int64_t rdpmc(u_int pmc);
tsc_uclock_t rdtsc(void);
u_int read_rflags(void);
void wbinvd(void);
void write_rflags(u_int rf);
void wrmsr(u_int msr, u_int64_t newval);
u_int64_t rdr0(void);
void load_dr0(u_int64_t dr0);
u_int64_t rdr1(void);
void load_dr1(u_int64_t dr1);
u_int64_t rdr2(void);
void load_dr2(u_int64_t dr2);
u_int64_t rdr3(void);
void load_dr3(u_int64_t dr3);
u_int64_t rdr4(void);
void load_dr4(u_int64_t dr4);
u_int64_t rdr5(void);
void load_dr5(u_int64_t dr5);
u_int64_t rdr6(void);
void load_dr6(u_int64_t dr6);
u_int64_t rdr7(void);
void load_dr7(u_int64_t dr7);
register_t intr_disable(void);
void intr_restore(register_t rf);
#endif
int rdmsr_safe(u_int msr, uint64_t *val);
int wrmsr_safe(u_int msr, uint64_t newval);
void reset_dbregs(void);
void smap_open(void);
void smap_close(void);
__END_DECLS
#endif