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
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
|
#define FOOLOS_MODULE_NAME "mp"
#include "x86.h"
#include "../lib/logger/log.h" // logger facilities
typedef struct mp_fps_struct
{
uint32_t sig; //signature "_MP_"
uint32_t conf; //pointer to config struct
uint8_t length; //should be 1
uint8_t version; // 1=1.1, 4=1.4
uint8_t checksum;
uint8_t features1;
uint8_t features2;
uint8_t res1; //reserved
uint8_t res2;
uint8_t res3;
}mp_fps;
typedef struct mp_config_struct
{
uint32_t sig; //signature "PCMP"
uint16_t length; //base table length
uint8_t version; //revision 1=1.1 4=1.4
uint8_t checksum;
uint32_t oemid1; //OEM id (ascii)
uint32_t oemid2;
uint32_t prodid1; //Product id (ascii)
uint32_t prodid2;
uint32_t prodid3;
uint32_t oem_table; //pointer (optional)
uint16_t oem_size; //size of this table
uint16_t entries; //entry count (following the header)
uint32_t local_apic; //local apic address (same for every cpu)
uint16_t length_ext; //extended table length (optional)
uint8_t check_ext; //checksum for ext. table
}mp_config;
//entries are sorted, but we do not care.
uint8_t *walk_mp_table(uint8_t *start_addr)
{
if(*start_addr==0x0||*start_addr==0x2)
log(FOOLOS_MODULE_NAME,FOOLOS_LOG_INFO,"entry type: %d",*start_addr);
if(*start_addr==0x00)return start_addr+20;
return start_addr+8;
}
void show_mp_conf(mp_config *addr)
{
char buf[]="XXXX";
uint32_t *buf_addr=buf;
*buf_addr=addr->sig;
log(FOOLOS_MODULE_NAME,FOOLOS_LOG_INFO,"mp_config tabel addr: %08X",addr);
log(FOOLOS_MODULE_NAME,FOOLOS_LOG_INFO,"mp_config signature: %s",buf);
log(FOOLOS_MODULE_NAME,FOOLOS_LOG_INFO,"mp_config version: %02X",addr->version);
log(FOOLOS_MODULE_NAME,FOOLOS_LOG_INFO,"mp_config # of entries: %d",addr->entries);
log(FOOLOS_MODULE_NAME,FOOLOS_LOG_INFO,"mp_config local apic addr: 0x%08X",addr->local_apic);
log(FOOLOS_MODULE_NAME,FOOLOS_LOG_INFO,"mp_config tabel length: %d",addr->length);
uint8_t *start_addr=addr;
start_addr+=44;
for(int i=0;i<addr->entries;i++)
{
// log(FOOLOS_MODULE_NAME,FOOLOS_LOG_INFO,"go 0x%08X",start_addr);
start_addr=walk_mp_table(start_addr);
}
}
void show_mp_fps(mp_fps *addr)
{
if(addr->length!=1)return;
if(addr->version!=1&&addr->version!=4)return;
char buf[]="XXXX";
uint32_t *buf_addr=buf;
*buf_addr=addr->sig;
log(FOOLOS_MODULE_NAME,FOOLOS_LOG_INFO,"signature: %s",buf);
log(FOOLOS_MODULE_NAME,FOOLOS_LOG_INFO,"conf: %08X",addr->conf);
log(FOOLOS_MODULE_NAME,FOOLOS_LOG_INFO,"ver: %02X",addr->version);
log(FOOLOS_MODULE_NAME,FOOLOS_LOG_INFO,"f1: %02X",addr->features1);
if(addr->features1!=0)panic(FOOLOS_MODULE_NAME,"Intel default config not supported yet!");
show_mp_conf(addr->conf);
}
bool check_mp(uint8_t *addr)
{
char test[]="_MP_";
for(int i=0;i<4;i++)
{
if(test[i]!=*(addr+i))return false;
}
return true;
}
// todo: check checksum,version etc. and narrow down search
bool find_mp()
{
log(FOOLOS_MODULE_NAME,FOOLOS_LOG_INFO,"Looking for Mp Floating Ponter Struct...");
uint8_t *addr=0x80000;
while(addr<=0xfffff)
{
if(check_mp(addr))
{
log(FOOLOS_MODULE_NAME,FOOLOS_LOG_INFO,"Found at 0x%04X",addr);
show_mp_fps(addr);
}
addr++;
}
addr=0x190000-1025;
while(addr<=0x190000)
{
if(check_mp(addr))
{
log(FOOLOS_MODULE_NAME,FOOLOS_LOG_INFO,"Found at 0x%04X",addr);
show_mp_fps(addr);
}
addr++;
}
return true;
}
|
