1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
|
#include "x86.h"
// get control registers (cr0-cr4)
uint32_t x86_get_cr0()
{
uint32_t cr;
asm volatile("mov %%cr0, %0": "=b"(cr));
return cr;
}
uint32_t x86_get_cr1()
{
uint32_t cr=0;
// reading the reserved cr1 register results in crash.
// (at least on emulators)
// asm volatile("mov %%cr1, %0": "=b"(cr));
return cr;
}
uint32_t x86_get_cr2()
{
uint32_t cr;
asm volatile("mov %%cr2, %0": "=b"(cr));
return cr;
}
uint32_t x86_get_cr3()
{
uint32_t cr=0;
asm volatile("mov %%cr3, %0": "=b"(cr));
return cr;
}
uint32_t x86_get_cr4()
{
uint32_t cr;
asm volatile("mov %%cr4, %0": "=b"(cr));
return cr;
}
void x86_outb(int port, uint8_t data)
{
__asm __volatile("outb %0,%w1" : : "a" (data), "d" (port));
}
uint8_t x86_inb(int port)
{
uint8_t data;
__asm __volatile("inb %w1,%0" : "=a" (data) : "d" (port));
return data;
}
void x86_outw(int port, uint16_t data)
{
__asm __volatile("outw %0,%w1" : : "a" (data), "d" (port));
}
uint16_t x86_inw(int port)
{
uint16_t data;
__asm __volatile("inw %w1,%0" : "=a" (data) : "d" (port));
return data;
}
void x86_outl(int port, uint32_t data)
{
__asm __volatile("outl %0,%w1" : : "a" (data), "d" (port));
}
uint32_t x86_inl(int port)
{
uint32_t data;
__asm __volatile("inl %w1,%0" : "=a" (data) : "d" (port));
return data;
}
void x86_set_pdbr(uint32_t addr)
{
asm volatile("mov %0, %%cr3":: "b"(addr));
}
// enable PT bit in CR0
void x86_paging_enable()
{
uint32_t cr0=x86_get_cr0();
cr0 |= 0x80000000; // enable paging
asm volatile("mov %0, %%cr0":: "b"(cr0));
}
// disable PT bit in CR0
void x86_paging_disable()
{
uint32_t cr0=x86_get_cr0();
cr0 &= ~0x80000000;
asm volatile("mov %0, %%cr0":: "b"(cr0));
}
void x86_flush_tlb(uint32_t addr)
{
asm volatile("invlpg (%0)" ::"r" (addr) : "memory");
}
|