X-Git-Url: http://wien.tomnetworks.com/gitweb/?a=blobdiff_plain;f=src%2Futil.h;h=70d3c4c3271ff468925ae515f54c5dfb3ebbdc44;hb=refs%2Fheads%2Fcoreboot;hp=36e9a30594e44c00cc70c7156267ead172a71e88;hpb=f205f9fdb63f87eafd2328955385eb94e9824c26;p=seabios.git diff --git a/src/util.h b/src/util.h index 36e9a30..70d3c4c 100644 --- a/src/util.h +++ b/src/util.h @@ -1,13 +1,12 @@ // Basic x86 asm functions and function defs. // -// Copyright (C) 2008 Kevin O'Connor +// Copyright (C) 2008-2010 Kevin O'Connor // -// This file may be distributed under the terms of the GNU GPLv3 license. +// This file may be distributed under the terms of the GNU LGPLv3 license. #ifndef __UTIL_H #define __UTIL_H -#include "ioport.h" // outb -#include "biosvar.h" // struct bregs +#include "types.h" // u32 static inline void irq_disable(void) { @@ -19,19 +18,23 @@ static inline void irq_enable(void) asm volatile("sti": : :"memory"); } -static inline unsigned long irq_save(void) +static inline u32 save_flags(void) { - unsigned long flags; - asm volatile("pushfl ; popl %0" : "=g" (flags)); - irq_disable(); + u32 flags; + asm volatile("pushfl ; popl %0" : "=rm" (flags)); return flags; } -static inline void irq_restore(unsigned long flags) +static inline void restore_flags(u32 flags) { asm volatile("pushl %0 ; popfl" : : "g" (flags) : "memory", "cc"); } +static inline void cpu_relax(void) +{ + asm volatile("rep ; nop": : :"memory"); +} + static inline void nop(void) { asm volatile("nop"); @@ -39,135 +42,447 @@ static inline void nop(void) static inline void hlt(void) { - asm volatile("hlt"); + asm volatile("hlt": : :"memory"); } -#define BX_PANIC(fmt, args...) bprintf(0, fmt , ##args) -#define BX_INFO(fmt, args...) bprintf(0, fmt , ##args) - -static inline void -memset(void *s, int c, size_t n) +static inline void wbinvd(void) { - while (n) - ((char *)s)[--n] = c; + asm volatile("wbinvd": : :"memory"); } -static inline void * -memcpy(void *d1, const void *s1, size_t len) +#define CPUID_TSC (1 << 4) +#define CPUID_MSR (1 << 5) +#define CPUID_APIC (1 << 9) +#define CPUID_MTRR (1 << 12) +static inline void __cpuid(u32 index, u32 *eax, u32 *ebx, u32 *ecx, u32 *edx) { - u8 *d = d1; - const u8 *s = s1; + asm("cpuid" + : "=a" (*eax), "=b" (*ebx), "=c" (*ecx), "=d" (*edx) + : "0" (index)); +} - while (len--) { - *d++ = *s++; - } - return d1; +static inline u32 getcr0(void) { + u32 cr0; + asm("movl %%cr0, %0" : "=r"(cr0)); + return cr0; +} +static inline void setcr0(u32 cr0) { + asm("movl %0, %%cr0" : : "r"(cr0)); } -static inline void -eoi_master_pic() +static inline u64 rdmsr(u32 index) { - outb(PIC1_IRQ5, PORT_PIC1); + u64 ret; + asm ("rdmsr" : "=A"(ret) : "c"(index)); + return ret; } -static inline void -eoi_both_pics() +static inline void wrmsr(u32 index, u64 val) { - outb(PIC2_IRQ13, PORT_PIC2); - eoi_master_pic(); + asm volatile ("wrmsr" : : "c"(index), "A"(val)); } -static inline -void call16(struct bregs *callregs) +static inline u64 rdtscll(void) { - asm volatile( - "pushl %%ebp\n" // Save state - "pushfl\n" -#ifdef MODE16 - "calll __call16\n" -#else - "calll __call16_from32\n" -#endif - "popfl\n" // Restore state - "popl %%ebp\n" - : "+a" (callregs), "+m" (*callregs) - : - : "ebx", "ecx", "edx", "esi", "edi"); + u64 val; + asm volatile("rdtsc" : "=A" (val)); + return val; } -static inline -void __call16_int(struct bregs *callregs, u16 offset) +static inline u32 __ffs(u32 word) { - callregs->cs = SEG_BIOS; - callregs->ip = offset; - call16(callregs); + asm("bsf %1,%0" + : "=r" (word) + : "rm" (word)); + return word; +} +static inline u32 __fls(u32 word) +{ + asm("bsr %1,%0" + : "=r" (word) + : "rm" (word)); + return word; } -#ifdef MODE16 -#define call16_int(nr, callregs) do { \ - extern void irq_trampoline_ ##nr (); \ - __call16_int((callregs), (u16)&irq_trampoline_ ##nr ); \ - } while (0) -#else -#include "../out/rom16.offset.auto.h" -#define call16_int(nr, callregs) \ - __call16_int((callregs), OFFSET_irq_trampoline_ ##nr ) -#endif +static inline u16 __htons_constant(u16 val) { + return (val<<8) | (val>>8); +} +static inline u32 __htonl_constant(u32 val) { + return (val<<24) | ((val&0xff00)<<8) | ((val&0xff0000)>>8) | (val>>24); +} +static inline u32 __htonl(u32 val) { + asm("bswapl %0" : "+r"(val)); + return val; +} +#define htonl(x) (__builtin_constant_p((u32)(x)) ? __htonl_constant(x) : __htonl(x)) +#define ntohl(x) htonl(x) +#define htons(x) __htons_constant(x) +#define ntohs(x) htons(x) -// output.c -void bprintf(u16 action, const char *fmt, ...) - __attribute__ ((format (printf, 2, 3))); -void __debug_enter(const char *fname, struct bregs *regs); -void __debug_fail(const char *fname, struct bregs *regs); -void __debug_stub(const char *fname, struct bregs *regs); -void __debug_isr(const char *fname, struct bregs *regs); -#define debug_enter(regs) \ - __debug_enter(__func__, regs) -#define debug_stub(regs) \ - __debug_stub(__func__, regs) -#define debug_isr(regs) \ - __debug_isr(__func__, regs) -#define printf(fmt, args...) \ - bprintf(1, fmt , ##args ) +static inline u16 cpu_to_le16(u16 x) +{ + return x; +} -// Frequently used return codes -#define RET_EUNSUPPORTED 0x86 -static inline void -set_success(struct bregs *regs) +static inline u32 cpu_to_le32(u32 x) { - set_cf(regs, 0); + return x; } -static inline void -set_code_success(struct bregs *regs) +static inline u32 le32_to_cpu(u32 x) { - regs->ah = 0; - set_cf(regs, 0); + return x; +} + +static inline u32 getesp(void) { + u32 esp; + asm("movl %%esp, %0" : "=rm"(esp)); + return esp; +} + +static inline void writel(void *addr, u32 val) { + *(volatile u32 *)addr = val; +} +static inline void writew(void *addr, u16 val) { + *(volatile u16 *)addr = val; +} +static inline void writeb(void *addr, u8 val) { + *(volatile u8 *)addr = val; +} +static inline u32 readl(const void *addr) { + return *(volatile const u32 *)addr; +} +static inline u16 readw(const void *addr) { + return *(volatile const u16 *)addr; +} +static inline u8 readb(const void *addr) { + return *(volatile const u8 *)addr; } -#define set_fail(regs) do { \ - __debug_fail(__func__, (regs)); \ - set_cf((regs), 1); \ +#define call16_simpint(nr, peax, pflags) do { \ + ASSERT16(); \ + asm volatile( \ + "pushl %%ebp\n" \ + "sti\n" \ + "stc\n" \ + "int %2\n" \ + "pushfl\n" \ + "popl %1\n" \ + "cli\n" \ + "cld\n" \ + "popl %%ebp" \ + : "+a"(*peax), "=c"(*pflags) \ + : "i"(nr) \ + : "ebx", "edx", "esi", "edi", "cc", "memory"); \ } while (0) -#define set_code_fail(regs, code) do { \ - set_fail(regs); \ - (regs)->ah = (code); \ +// GDT bits +#define GDT_CODE (0x9bULL << 40) // Code segment - P,R,A bits also set +#define GDT_DATA (0x93ULL << 40) // Data segment - W,A bits also set +#define GDT_B (0x1ULL << 54) // Big flag +#define GDT_G (0x1ULL << 55) // Granularity flag +// GDT bits for segment base +#define GDT_BASE(v) ((((u64)(v) & 0xff000000) << 32) \ + | (((u64)(v) & 0x00ffffff) << 16)) +// GDT bits for segment limit (0-1Meg) +#define GDT_LIMIT(v) ((((u64)(v) & 0x000f0000) << 32) \ + | (((u64)(v) & 0x0000ffff) << 0)) +// GDT bits for segment limit (0-4Gig in 4K chunks) +#define GDT_GRANLIMIT(v) (GDT_G | GDT_LIMIT((v) >> 12)) + +struct descloc_s { + u16 length; + u32 addr; +} PACKED; + +// util.c +void cpuid(u32 index, u32 *eax, u32 *ebx, u32 *ecx, u32 *edx); +struct bregs; +inline void call16(struct bregs *callregs); +inline void call16big(struct bregs *callregs); +inline void __call16_int(struct bregs *callregs, u16 offset); +#define call16_int(nr, callregs) do { \ + extern void irq_trampoline_ ##nr (); \ + __call16_int((callregs), (u32)&irq_trampoline_ ##nr ); \ + } while (0) +u8 checksum_far(u16 buf_seg, void *buf_far, u32 len); +u8 checksum(void *buf, u32 len); +size_t strlen(const char *s); +int memcmp(const void *s1, const void *s2, size_t n); +int strcmp(const char *s1, const char *s2); +inline void memset_far(u16 d_seg, void *d_far, u8 c, size_t len); +inline void memset16_far(u16 d_seg, void *d_far, u16 c, size_t len); +void *memset(void *s, int c, size_t n); +void memset_fl(void *ptr, u8 val, size_t size); +inline void memcpy_far(u16 d_seg, void *d_far + , u16 s_seg, const void *s_far, size_t len); +void memcpy_fl(void *d_fl, const void *s_fl, size_t len); +void *memcpy(void *d1, const void *s1, size_t len); +#if MODESEGMENT == 0 +#define memcpy __builtin_memcpy +#endif +void iomemcpy(void *d, const void *s, u32 len); +void *memmove(void *d, const void *s, size_t len); +char *strtcpy(char *dest, const char *src, size_t len); +char *strchr(const char *s, int c); +void nullTrailingSpace(char *buf); +int get_keystroke(int msec); + +// stacks.c +u32 call32(void *func, u32 eax, u32 errret); +inline u32 stack_hop(u32 eax, u32 edx, void *func); +extern struct thread_info MainThread; +extern int CanPreempt; +struct thread_info *getCurThread(void); +void yield(void); +void wait_irq(void); +void run_thread(void (*func)(void*), void *data); +void wait_threads(void); +struct mutex_s { u32 isLocked; }; +void mutex_lock(struct mutex_s *mutex); +void mutex_unlock(struct mutex_s *mutex); +void start_preempt(void); +void finish_preempt(void); +int wait_preempt(void); +void check_preempt(void); + +// output.c +void debug_serial_setup(void); +void panic(const char *fmt, ...) + __attribute__ ((format (printf, 1, 2))) __noreturn; +void printf(const char *fmt, ...) + __attribute__ ((format (printf, 1, 2))); +int snprintf(char *str, size_t size, const char *fmt, ...) + __attribute__ ((format (printf, 3, 4))); +char * znprintf(size_t size, const char *fmt, ...) + __attribute__ ((format (printf, 2, 3))); +void __dprintf(const char *fmt, ...) + __attribute__ ((format (printf, 1, 2))); +void __debug_enter(struct bregs *regs, const char *fname); +void __debug_isr(const char *fname); +void __debug_stub(struct bregs *regs, int lineno, const char *fname); +void __warn_invalid(struct bregs *regs, int lineno, const char *fname); +void __warn_unimplemented(struct bregs *regs, int lineno, const char *fname); +void __warn_internalerror(int lineno, const char *fname); +void __warn_noalloc(int lineno, const char *fname); +void __warn_timeout(int lineno, const char *fname); +void __set_invalid(struct bregs *regs, int lineno, const char *fname); +void __set_unimplemented(struct bregs *regs, int lineno, const char *fname); +void __set_code_invalid(struct bregs *regs, u32 linecode, const char *fname); +void __set_code_unimplemented(struct bregs *regs, u32 linecode + , const char *fname); +void hexdump(const void *d, int len); + +#define dprintf(lvl, fmt, args...) do { \ + if (CONFIG_DEBUG_LEVEL && (lvl) <= CONFIG_DEBUG_LEVEL) \ + __dprintf((fmt) , ##args ); \ + } while (0) +#define debug_enter(regs, lvl) do { \ + if ((lvl) && (lvl) <= CONFIG_DEBUG_LEVEL) \ + __debug_enter((regs), __func__); \ + } while (0) +#define debug_isr(lvl) do { \ + if ((lvl) && (lvl) <= CONFIG_DEBUG_LEVEL) \ + __debug_isr(__func__); \ } while (0) +#define debug_stub(regs) \ + __debug_stub((regs), __LINE__, __func__) +#define warn_invalid(regs) \ + __warn_invalid((regs), __LINE__, __func__) +#define warn_unimplemented(regs) \ + __warn_unimplemented((regs), __LINE__, __func__) +#define warn_internalerror() \ + __warn_internalerror(__LINE__, __func__) +#define warn_noalloc() \ + __warn_noalloc(__LINE__, __func__) +#define warn_timeout() \ + __warn_timeout(__LINE__, __func__) +#define set_invalid(regs) \ + __set_invalid((regs), __LINE__, __func__) +#define set_code_invalid(regs, code) \ + __set_code_invalid((regs), (code) | (__LINE__ << 8), __func__) +#define set_unimplemented(regs) \ + __set_unimplemented((regs), __LINE__, __func__) +#define set_code_unimplemented(regs, code) \ + __set_code_unimplemented((regs), (code) | (__LINE__ << 8), __func__) // kbd.c +void kbd_setup(void); void handle_15c2(struct bregs *regs); +void process_key(u8 key); + +// mouse.c +void mouse_setup(void); +void process_mouse(u8 data); + +// system.c +extern u32 RamSize; +extern u64 RamSizeOver4G; +void mathcp_setup(void); + +// serial.c +void serial_setup(void); +void lpt_setup(void); // clock.c +#define PIT_TICK_RATE 1193180 // Underlying HZ of PIT +#define PIT_TICK_INTERVAL 65536 // Default interval for 18.2Hz timer +int check_tsc(u64 end); +void timer_setup(void); +void ndelay(u32 count); +void udelay(u32 count); +void mdelay(u32 count); +void nsleep(u32 count); +void usleep(u32 count); +void msleep(u32 count); +u64 calc_future_tsc(u32 msecs); +u64 calc_future_tsc_usec(u32 usecs); +u32 calc_future_timer_ticks(u32 count); +u32 calc_future_timer(u32 msecs); +int check_timer(u32 end); void handle_1583(struct bregs *regs); +void handle_1586(struct bregs *regs); +void useRTC(void); +void releaseRTC(void); // apm.c -void VISIBLE16 handle_1553(struct bregs *regs); +void apm_shutdown(void); +void handle_1553(struct bregs *regs); -// util.c -void usleep(u32 count); +// pcibios.c +void handle_1ab1(struct bregs *regs); +void bios32_setup(void); + +// shadow.c +void make_bios_writable(void); +void make_bios_readonly(void); +void qemu_prep_reset(void); + +// pciinit.c +extern const u8 pci_irqs[4]; +void pci_setup(void); + +// smm.c +void smm_init(void); + +// smp.c +extern u32 CountCPUs; +extern u32 MaxCountCPUs; +void wrmsr_smp(u32 index, u64 val); +void smp_probe(void); + +// coreboot.c +extern const char *CBvendor, *CBpart; +struct cbfs_file; +struct cbfs_file *cbfs_finddatafile(const char *fname); +struct cbfs_file *cbfs_findprefix(const char *prefix, struct cbfs_file *last); +u32 cbfs_datasize(struct cbfs_file *file); +const char *cbfs_filename(struct cbfs_file *file); +int cbfs_copyfile(struct cbfs_file *file, void *dst, u32 maxlen); +void cbfs_run_payload(struct cbfs_file *file); +void coreboot_copy_biostable(void); +void cbfs_payload_setup(void); +void coreboot_setup(void); + +// biostable.c +void copy_pir(void *pos); +void copy_mptable(void *pos); +void copy_acpi_rsdp(void *pos); +void copy_smbios(void *pos); + +// vgahooks.c +void handle_155f(struct bregs *regs); +struct pci_device; +void vgahook_setup(struct pci_device *pci); + +// optionroms.c +void call_bcv(u16 seg, u16 ip); +void optionrom_setup(void); +void vga_setup(void); +void s3_resume_vga_init(void); +extern u32 RomEnd; +extern int ScreenAndDebug; + +// bootsplash.c +void enable_vga_console(void); +void enable_bootsplash(void); +void disable_bootsplash(void); + +// resume.c +extern int HaveRunPost; +void init_dma(void); + +// pnpbios.c +#define PNP_SIGNATURE 0x506e5024 // $PnP +u16 get_pnp_offset(void); +void pnp_setup(void); + +// pmm.c +extern struct zone_s ZoneLow, ZoneHigh, ZoneFSeg, ZoneTmpLow, ZoneTmpHigh; +void malloc_setup(void); +void malloc_fixupreloc(void); +void malloc_finalize(void); +void *pmm_malloc(struct zone_s *zone, u32 handle, u32 size, u32 align); +int pmm_free(void *data); +void pmm_setup(void); +void pmm_finalize(void); +#define PMM_DEFAULT_HANDLE 0xFFFFFFFF +// Minimum alignment of malloc'd memory +#define MALLOC_MIN_ALIGN 16 +// Helper functions for memory allocation. +static inline void *malloc_low(u32 size) { + return pmm_malloc(&ZoneLow, PMM_DEFAULT_HANDLE, size, MALLOC_MIN_ALIGN); +} +static inline void *malloc_high(u32 size) { + return pmm_malloc(&ZoneHigh, PMM_DEFAULT_HANDLE, size, MALLOC_MIN_ALIGN); +} +static inline void *malloc_fseg(u32 size) { + return pmm_malloc(&ZoneFSeg, PMM_DEFAULT_HANDLE, size, MALLOC_MIN_ALIGN); +} +static inline void *malloc_tmplow(u32 size) { + return pmm_malloc(&ZoneTmpLow, PMM_DEFAULT_HANDLE, size, MALLOC_MIN_ALIGN); +} +static inline void *malloc_tmphigh(u32 size) { + return pmm_malloc(&ZoneTmpHigh, PMM_DEFAULT_HANDLE, size, MALLOC_MIN_ALIGN); +} +static inline void *malloc_tmp(u32 size) { + void *ret = malloc_tmphigh(size); + if (ret) + return ret; + return malloc_tmplow(size); +} +static inline void *memalign_low(u32 align, u32 size) { + return pmm_malloc(&ZoneLow, PMM_DEFAULT_HANDLE, size, align); +} +static inline void *memalign_high(u32 align, u32 size) { + return pmm_malloc(&ZoneHigh, PMM_DEFAULT_HANDLE, size, align); +} +static inline void *memalign_tmplow(u32 align, u32 size) { + return pmm_malloc(&ZoneTmpLow, PMM_DEFAULT_HANDLE, size, align); +} +static inline void *memalign_tmphigh(u32 align, u32 size) { + return pmm_malloc(&ZoneTmpHigh, PMM_DEFAULT_HANDLE, size, align); +} +static inline void *memalign_tmp(u32 align, u32 size) { + void *ret = memalign_tmphigh(align, size); + if (ret) + return ret; + return memalign_tmplow(align, size); +} +static inline void free(void *data) { + pmm_free(data); +} + +// mtrr.c +void mtrr_setup(void); + +// romlayout.S +void reset_vector(void) __noreturn; + +// misc.c +extern u8 BiosChecksum; -// rombios32.c -void rombios32_init(void); +// version (auto generated file out/version.c) +extern const char VERSION[]; #endif // util.h