Enhance included bios tables.
[people/mcb30/legacybios.git] / src / util.h
1 // Basic x86 asm functions and function defs.
2 //
3 // Copyright (C) 2008  Kevin O'Connor <kevin@koconnor.net>
4 //
5 // This file may be distributed under the terms of the GNU GPLv3 license.
6 #ifndef __UTIL_H
7 #define __UTIL_H
8
9 #include "ioport.h" // outb
10 #include "biosvar.h" // struct bregs
11
12 static inline void irq_disable(void)
13 {
14     asm volatile("cli": : :"memory");
15 }
16
17 static inline void irq_enable(void)
18 {
19     asm volatile("sti": : :"memory");
20 }
21
22 static inline unsigned long irq_save(void)
23 {
24     unsigned long flags;
25     asm volatile("pushfl ; popl %0" : "=g" (flags));
26     irq_disable();
27     return flags;
28 }
29
30 static inline void irq_restore(unsigned long flags)
31 {
32     asm volatile("pushl %0 ; popfl" : : "g" (flags) : "memory", "cc");
33 }
34
35 static inline void nop(void)
36 {
37     asm volatile("nop");
38 }
39
40 #define DEBUGF(fmt, args...) bprintf(0, fmt , ##args)
41 #define BX_PANIC(fmt, args...) bprintf(0, fmt , ##args)
42 #define BX_INFO(fmt, args...) bprintf(0, fmt , ##args)
43
44 static inline void
45 memset(void *s, int c, size_t n)
46 {
47     while (n)
48         ((char *)s)[--n] = c;
49 }
50
51 static inline void
52 eoi_master_pic()
53 {
54     outb(PIC1_IRQ5, PORT_PIC1);
55 }
56
57 static inline void
58 eoi_both_pics()
59 {
60     outb(PIC2_IRQ13, PORT_PIC2);
61     eoi_master_pic();
62 }
63
64 static inline
65 void call16(struct bregs *callregs)
66 {
67     asm volatile(
68         "pushl %%ebp\n" // Save state
69         "pushfl\n"
70 #ifdef MODE16
71         "calll __call16\n"
72 #else
73         "calll __call16_from32\n"
74 #endif
75         "popfl\n"       // Restore state
76         "popl %%ebp\n"
77         : "+a" (callregs), "+m" (*callregs)
78         :
79         : "ebx", "ecx", "edx", "esi", "edi");
80 }
81
82 static inline
83 void __call16_int(struct bregs *callregs, u16 offset)
84 {
85     callregs->cs = SEG_BIOS;
86     callregs->ip = offset;
87     call16(callregs);
88 }
89
90 #ifdef MODE16
91 #define call16_int(nr, callregs) do {                           \
92         extern void irq_trampoline_ ##nr ();                    \
93         __call16_int((callregs), (u16)&irq_trampoline_ ##nr );  \
94     } while (0)
95 #else
96 #include "../out/rom16.offset.auto.h"
97 #define call16_int(nr, callregs)                                \
98     __call16_int((callregs), OFFSET_irq_trampoline_ ##nr )
99 #endif
100
101 // output.c
102 void bprintf(u16 action, const char *fmt, ...)
103     __attribute__ ((format (printf, 2, 3)));
104 void __debug_enter(const char *fname, struct bregs *regs);
105 void __debug_exit(const char *fname, struct bregs *regs);
106 void __debug_stub(const char *fname, struct bregs *regs);
107 #define debug_enter(regs) \
108     __debug_enter(__func__, regs)
109 #define debug_exit(regs) \
110     __debug_exit(__func__, regs)
111 #define debug_stub(regs) \
112     __debug_stub(__func__, regs)
113 #define printf(fmt, args...)                     \
114     bprintf(1, fmt , ##args )
115
116 // kbd.c
117 void handle_15c2(struct bregs *regs);
118
119 // clock.c
120 void handle_1583(struct bregs *regs);
121
122 // Frequent bios return helper
123 #define RET_EUNSUPPORTED 0x86
124 static inline void
125 handle_ret(struct bregs *regs, u8 code)
126 {
127     regs->ah = code;
128     set_cf(regs, code);
129 }
130
131 #endif // util.h