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
109
110
111
112
113
114
115
|
#include <kernel/types.h>
#include <kernel/console.H>
#include <kernel/task.H>
#include <kernel/taskmgr.H>
#include <kernel/ppcarch.H>
#include <kernel/vmmmgr.H>
namespace Systemcalls { void TaskEnd(task_t*); }
namespace ExceptionHandles
{
bool HvEmulation(task_t*);
}
const uint64_t EXCEPTION_SRR1_MASK = 0x00000000783F0000;
const uint64_t EXCEPTION_SRR1_HVEMUL = 0x0000000000080000;
extern "C"
void kernel_execute_prog_ex()
{
task_t* t = TaskManager::getCurrentTask();
uint64_t exception = ppc_getSRR1() & EXCEPTION_SRR1_MASK;
bool handled = false;
switch(exception)
{
case EXCEPTION_SRR1_HVEMUL:
handled = ExceptionHandles::HvEmulation(t);
break;
}
if (!handled)
{
printk("Program exception, killing task %d\n", t->tid);
Systemcalls::TaskEnd(t);
}
}
const uint64_t EXCEPTION_DSISR_MASK = 0x0000000040000000;
const uint64_t EXCEPTION_DSISR_PTEMISS = 0x0000000040000000;
extern "C"
void kernel_execute_data_storage()
{
task_t* t = TaskManager::getCurrentTask();
uint64_t exception = ppc_getDSISR() & EXCEPTION_DSISR_MASK;
bool handled = false;
switch(exception)
{
case EXCEPTION_DSISR_PTEMISS:
handled = VmmManager::pteMiss(t);
break;
}
if (!handled)
{
printk("Data Storage exception on %d: %llx, %llx\n",
t->tid, ppc_getDAR(), ppc_getDSISR());
Systemcalls::TaskEnd(t);
}
}
extern "C"
void kernel_execute_data_segment()
{
task_t* t = TaskManager::getCurrentTask();
printk("Data Segment exception, killing task %d\n", t->tid);
Systemcalls::TaskEnd(t);
}
extern "C"
void kernel_execute_inst_storage()
{
task_t* t = TaskManager::getCurrentTask();
printk("Inst Storage exception, killing task %d\n", t->tid);
Systemcalls::TaskEnd(t);
}
extern "C"
void kernel_execute_inst_segment()
{
task_t* t = TaskManager::getCurrentTask();
printk("Inst Segment exception, killing task %d\n", t->tid);
Systemcalls::TaskEnd(t);
}
extern "C"
void kernel_execute_alignment()
{
task_t* t = TaskManager::getCurrentTask();
printk("Alignment exception, killing task %d\n", t->tid);
Systemcalls::TaskEnd(t);
}
namespace ExceptionHandles
{
bool HvEmulation(task_t* t)
{
/*printk("NIP = %llx : Inst = %lx\n",
t->context.nip,
(*(uint32_t*)t->context.nip));*/
uint32_t instruction = *(uint32_t*)t->context.nip;
// check for mfsprg3
if ((instruction & 0xfc1fffff) == 0x7c1342a6)
{
t->context.gprs[(instruction & 0x03E00000) >> 21] =
(uint64_t) t;
t->context.nip = (void*) (((uint64_t)t->context.nip)+4);
return true;
}
return false;
}
}
|