1 // Basic x86 asm functions and function defs.
3 // Copyright (C) 2008 Kevin O'Connor <kevin@koconnor.net>
5 // This file may be distributed under the terms of the GNU GPLv3 license.
9 #include "ioport.h" // outb
10 #include "biosvar.h" // struct bregs
12 static inline void irq_disable(void)
14 asm volatile("cli": : :"memory");
17 static inline void irq_enable(void)
19 asm volatile("sti": : :"memory");
22 static inline unsigned long irq_save(void)
25 asm volatile("pushfl ; popl %0" : "=g" (flags));
30 static inline void irq_restore(unsigned long flags)
32 asm volatile("pushl %0 ; popfl" : : "g" (flags) : "memory", "cc");
35 static inline void nop(void)
40 static inline void hlt(void)
45 #define BX_PANIC(fmt, args...) bprintf(0, fmt , ##args)
46 #define BX_INFO(fmt, args...) bprintf(0, fmt , ##args)
49 memset(void *s, int c, size_t n)
56 memcpy(void *d, void *s, size_t n)
59 ((char *)d)[n-1] = ((char *)s)[n-1];
67 outb(PIC1_IRQ5, PORT_PIC1);
73 outb(PIC2_IRQ13, PORT_PIC2);
78 void call16(struct bregs *callregs)
81 "pushl %%ebp\n" // Save state
86 "calll __call16_from32\n"
88 "popfl\n" // Restore state
90 : "+a" (callregs), "+m" (*callregs)
92 : "ebx", "ecx", "edx", "esi", "edi");
96 void __call16_int(struct bregs *callregs, u16 offset)
98 callregs->cs = SEG_BIOS;
99 callregs->ip = offset;
104 #define call16_int(nr, callregs) do { \
105 extern void irq_trampoline_ ##nr (); \
106 __call16_int((callregs), (u16)&irq_trampoline_ ##nr ); \
109 #include "../out/rom16.offset.auto.h"
110 #define call16_int(nr, callregs) \
111 __call16_int((callregs), OFFSET_irq_trampoline_ ##nr )
115 void bprintf(u16 action, const char *fmt, ...)
116 __attribute__ ((format (printf, 2, 3)));
117 void __debug_enter(const char *fname, struct bregs *regs);
118 void __debug_exit(const char *fname, struct bregs *regs);
119 void __debug_stub(const char *fname, struct bregs *regs);
120 void __debug_isr(const char *fname, struct bregs *regs);
121 #define debug_enter(regs) \
122 __debug_enter(__func__, regs)
123 #define debug_exit(regs) \
124 __debug_exit(__func__, regs)
125 #define debug_stub(regs) \
126 __debug_stub(__func__, regs)
127 #define debug_isr(regs) \
128 __debug_isr(__func__, regs)
129 #define printf(fmt, args...) \
130 bprintf(1, fmt , ##args )
133 void handle_15c2(struct bregs *regs);
136 void handle_1583(struct bregs *regs);
139 void handle_1553(struct bregs *regs);
141 // Frequent bios return helper
142 #define RET_EUNSUPPORTED 0x86
144 handle_ret(struct bregs *regs, u8 code)
151 align(unsigned long addr, unsigned long v)
153 return (addr + v - 1) & ~(v - 1);