|
faluco@41
|
1 |
#include <malloc.h> |
|
faluco@41
|
2 |
#include <string.h> |
|
faluco@41
|
3 |
#include "sp_vm.h" |
|
faluco@41
|
4 |
#include "zlib/zlib.h" |
|
faluco@41
|
5 |
|
|
faluco@41
|
6 |
sp_plugin_t *_ReadPlugin(sp_file_hdr_t *hdr, uint8_t *base, sp_plugin_t *plugin, int *err) |
|
faluco@41
|
7 |
{ |
|
faluco@41
|
8 |
char *nameptr; |
|
faluco@41
|
9 |
uint8_t sectnum = 0; |
|
faluco@41
|
10 |
|
|
faluco@41
|
11 |
sp_plugin_infotab_t *info = (sp_plugin_infotab_t *)malloc(sizeof(sp_plugin_infotab_t)); |
|
faluco@41
|
12 |
sp_plugin_debug_t *dbg = (sp_plugin_debug_t *)malloc(sizeof(sp_plugin_debug_t)); |
|
faluco@41
|
13 |
|
|
faluco@41
|
14 |
sp_file_section_t *secptr = (sp_file_section_t *)(base + sizeof(sp_file_hdr_t)); |
|
faluco@41
|
15 |
|
|
faluco@41
|
16 |
memset(plugin, 0, sizeof(sp_plugin_t)); |
|
faluco@41
|
17 |
memset(info, 0, sizeof(sp_plugin_infotab_t)); |
|
faluco@41
|
18 |
memset(dbg, 0, sizeof(sp_plugin_debug_t)); |
|
faluco@41
|
19 |
|
|
faluco@41
|
20 |
plugin->base = base; |
|
faluco@41
|
21 |
plugin->info = info; |
|
faluco@41
|
22 |
plugin->debug = dbg; |
|
faluco@41
|
23 |
|
|
faluco@41
|
24 |
while (sectnum < hdr->sections) |
|
faluco@41
|
25 |
{ |
|
faluco@41
|
26 |
nameptr = base + hdr->stringtab + secptr->nameoffs; |
|
faluco@41
|
27 |
|
|
faluco@41
|
28 |
if (!(plugin->pcode) && !strcmp(nameptr, ".code")) |
|
faluco@41
|
29 |
{ |
|
faluco@41
|
30 |
sp_file_code_t *cod = (sp_file_code_t *)(base + secptr->dataoffs); |
|
faluco@41
|
31 |
plugin->pcode = base + secptr->dataoffs + cod->code; |
|
faluco@41
|
32 |
plugin->pcode_size = cod->codesize; |
|
faluco@41
|
33 |
plugin->flags = cod->flags; |
|
faluco@41
|
34 |
} |
|
faluco@41
|
35 |
else if (!(plugin->data) && !strcmp(nameptr, ".data")) |
|
faluco@41
|
36 |
{ |
|
faluco@41
|
37 |
sp_file_data_t *dat = (sp_file_data_t *)(base + secptr->dataoffs); |
|
faluco@41
|
38 |
plugin->data = base + secptr->dataoffs + dat->data; |
|
faluco@41
|
39 |
plugin->data_size = dat->datasize; |
|
faluco@41
|
40 |
plugin->memory = dat->memsize; |
|
faluco@41
|
41 |
} |
|
faluco@41
|
42 |
else if (!(plugin->info->publics) && !strcmp(nameptr, ".publics")) |
|
faluco@41
|
43 |
{ |
|
faluco@41
|
44 |
plugin->info->publics_num = secptr->size / sizeof(sp_file_publics_t); |
|
faluco@41
|
45 |
plugin->info->publics = (sp_file_publics_t *)(base + secptr->dataoffs); |
|
faluco@41
|
46 |
} |
|
faluco@41
|
47 |
else if (!(plugin->info->pubvars) && !strcmp(nameptr, ".pubvars")) |
|
faluco@41
|
48 |
{ |
|
faluco@41
|
49 |
plugin->info->pubvars_num = secptr->size / sizeof(sp_file_pubvars_t); |
|
faluco@41
|
50 |
plugin->info->pubvars = (sp_file_pubvars_t *)(base + secptr->dataoffs); |
|
faluco@41
|
51 |
} |
|
faluco@41
|
52 |
else if (!(plugin->info->natives) && !strcmp(nameptr, ".natives")) |
|
faluco@41
|
53 |
{ |
|
faluco@41
|
54 |
plugin->info->natives_num = secptr->size / sizeof(sp_file_natives_t); |
|
faluco@41
|
55 |
plugin->info->natives = (sp_file_natives_t *)(base + secptr->dataoffs); |
|
faluco@41
|
56 |
} |
|
faluco@47
|
57 |
else if (!(plugin->info->stringbase) && !strcmp(nameptr, ".names")) |
|
faluco@47
|
58 |
{ |
|
faluco@47
|
59 |
plugin->info->stringbase = base + secptr->dataoffs; |
|
faluco@47
|
60 |
} |
|
faluco@41
|
61 |
else if (!(plugin->debug->files) && !strcmp(nameptr, ".dbg.files")) |
|
faluco@41
|
62 |
{ |
|
faluco@41
|
63 |
plugin->debug->files = (sp_fdbg_file_t *)(base + secptr->dataoffs); |
|
faluco@41
|
64 |
} |
|
faluco@47
|
65 |
else if (!(plugin->debug->lines) && !strcmp(nameptr, ".dbg.lines")) |
|
faluco@47
|
66 |
{ |
|
faluco@47
|
67 |
plugin->debug->lines = (sp_fdbg_line_t *)(base + secptr->dataoffs); |
|
faluco@47
|
68 |
} |
|
faluco@47
|
69 |
else if (!(plugin->debug->symbols) && !strcmp(nameptr, ".dbg.symbols")) |
|
faluco@47
|
70 |
{ |
|
faluco@47
|
71 |
plugin->debug->symbols = (sp_fdbg_symbol_t *)(base + secptr->dataoffs); |
|
faluco@47
|
72 |
} |
|
faluco@47
|
73 |
else if (!(plugin->debug->lines_num) && !strcmp(nameptr, ".dbg.info")) |
|
faluco@47
|
74 |
{ |
|
faluco@47
|
75 |
sp_fdbg_info_t *inf = (sp_fdbg_info_t *)(base + secptr->dataoffs); |
|
faluco@47
|
76 |
plugin->debug->files_num = inf->num_files; |
|
faluco@47
|
77 |
plugin->debug->lines_num = inf->num_lines; |
|
faluco@47
|
78 |
plugin->debug->syms_num = inf->num_syms; |
|
faluco@47
|
79 |
} |
|
faluco@41
|
80 |
else if (!(plugin->debug->stringbase) && !strcmp(nameptr, ".dbg.strings")) |
|
faluco@41
|
81 |
{ |
|
faluco@41
|
82 |
plugin->debug->stringbase = base + secptr->dataoffs; |
|
faluco@41
|
83 |
} |
|
faluco@47
|
84 |
|
|
faluco@41
|
85 |
secptr++; |
|
faluco@41
|
86 |
sectnum++; |
|
faluco@41
|
87 |
} |
|
faluco@41
|
88 |
|
|
faluco@41
|
89 |
if (!(plugin->pcode) || !(plugin->data) || !(plugin->info->stringbase)) |
|
faluco@41
|
90 |
goto return_error; |
|
faluco@41
|
91 |
|
|
faluco@41
|
92 |
if ((plugin->flags == SP_FILE_DEBUG) && (!(plugin->debug->files) || !(plugin->debug->lines) || !(plugin->debug->symbols))) |
|
faluco@41
|
93 |
goto return_error; |
|
faluco@41
|
94 |
|
|
faluco@44
|
95 |
if (err) |
|
faluco@44
|
96 |
*err = SP_ERR_NONE; |
|
faluco@44
|
97 |
|
|
faluco@41
|
98 |
return plugin; |
|
faluco@41
|
99 |
|
|
faluco@41
|
100 |
return_error: |
|
faluco@41
|
101 |
free(dbg); |
|
faluco@41
|
102 |
free(info); |
|
faluco@41
|
103 |
|
|
faluco@41
|
104 |
if (err) |
|
faluco@41
|
105 |
*err = SP_ERR_FILE_FORMAT; |
|
faluco@41
|
106 |
|
|
faluco@41
|
107 |
return NULL; |
|
faluco@41
|
108 |
} |
|
faluco@41
|
109 |
|
|
faluco@41
|
110 |
sp_plugin_t *SP_LoadFromFilePointer(FILE *fp, int *err) |
|
faluco@41
|
111 |
{ |
|
faluco@41
|
112 |
sp_file_hdr_t hdr; |
|
faluco@41
|
113 |
sp_plugin_t *plugin; |
|
faluco@41
|
114 |
uint8_t *base; |
|
faluco@41
|
115 |
int z_result; |
|
faluco@41
|
116 |
int error; |
|
faluco@41
|
117 |
|
|
faluco@41
|
118 |
if (!fp) |
|
faluco@41
|
119 |
{ |
|
faluco@41
|
120 |
error = SP_ERR_NOT_FOUND; |
|
faluco@41
|
121 |
goto return_error; |
|
faluco@41
|
122 |
} |
|
faluco@41
|
123 |
|
|
faluco@41
|
124 |
/* Rewind for safety */ |
|
faluco@41
|
125 |
rewind(fp); |
|
faluco@41
|
126 |
fread(&hdr, sizeof(sp_file_hdr_t), 1, fp); |
|
faluco@41
|
127 |
|
|
faluco@41
|
128 |
if (hdr.magic != SPFILE_MAGIC) |
|
faluco@41
|
129 |
{ |
|
faluco@41
|
130 |
error = SP_ERR_FILE_FORMAT; |
|
faluco@41
|
131 |
goto return_error; |
|
faluco@41
|
132 |
} |
|
faluco@41
|
133 |
|
|
faluco@41
|
134 |
switch (hdr.compression) |
|
faluco@41
|
135 |
{ |
|
faluco@41
|
136 |
case SPFILE_COMPRESSION_GZ: |
|
faluco@41
|
137 |
{ |
|
faluco@41
|
138 |
uint32_t uncompsize = hdr.imagesize - hdr.dataoffs; |
|
faluco@41
|
139 |
uint32_t compsize = hdr.disksize - hdr.dataoffs; |
|
faluco@41
|
140 |
uint32_t sectsize = hdr.dataoffs - sizeof(sp_file_hdr_t); |
|
faluco@41
|
141 |
uLongf destlen = uncompsize; |
|
faluco@41
|
142 |
|
|
faluco@41
|
143 |
char *tempbuf = (char *)malloc(compsize); |
|
faluco@41
|
144 |
void *uncompdata = malloc(uncompsize); |
|
faluco@41
|
145 |
void *sectheader = malloc(sectsize); |
|
faluco@41
|
146 |
|
|
faluco@41
|
147 |
fread(sectheader, sectsize, 1, fp); |
|
faluco@41
|
148 |
fread(tempbuf, compsize, 1, fp); |
|
faluco@41
|
149 |
|
|
faluco@41
|
150 |
z_result = uncompress((Bytef *)uncompdata, &destlen, (Bytef *)tempbuf, compsize); |
|
faluco@41
|
151 |
free(tempbuf); |
|
faluco@41
|
152 |
if (z_result != Z_OK) |
|
faluco@41
|
153 |
{ |
|
faluco@41
|
154 |
free(sectheader); |
|
faluco@41
|
155 |
free(uncompdata); |
|
faluco@41
|
156 |
error = SP_ERR_DECOMPRESSOR; |
|
faluco@41
|
157 |
goto return_error; |
|
faluco@41
|
158 |
} |
|
faluco@41
|
159 |
|
|
faluco@41
|
160 |
base = (uint8_t *)malloc(hdr.imagesize); |
|
faluco@41
|
161 |
memcpy(base, &hdr, sizeof(sp_file_hdr_t)); |
|
faluco@41
|
162 |
memcpy(base + sizeof(sp_file_hdr_t), sectheader, sectsize); |
|
faluco@41
|
163 |
free(sectheader); |
|
faluco@41
|
164 |
memcpy(base + hdr.dataoffs, uncompdata, uncompsize); |
|
faluco@41
|
165 |
free(uncompdata); |
|
faluco@41
|
166 |
break; |
|
faluco@41
|
167 |
} |
|
faluco@41
|
168 |
case SPFILE_COMPRESSION_NONE: |
|
faluco@41
|
169 |
{ |
|
faluco@41
|
170 |
base = (uint8_t *)malloc(hdr.imagesize); |
|
faluco@41
|
171 |
rewind(fp); |
|
faluco@41
|
172 |
fread(base, hdr.imagesize, 1, fp); |
|
faluco@41
|
173 |
break; |
|
faluco@41
|
174 |
} |
|
faluco@41
|
175 |
default: |
|
faluco@41
|
176 |
{ |
|
faluco@41
|
177 |
error = SP_ERR_DECOMPRESSOR; |
|
faluco@41
|
178 |
goto return_error; |
|
faluco@41
|
179 |
} |
|
faluco@41
|
180 |
} |
|
faluco@41
|
181 |
|
|
faluco@41
|
182 |
plugin = (sp_plugin_t *)malloc(sizeof(sp_plugin_t)); |
|
faluco@41
|
183 |
if (!_ReadPlugin(&hdr, base, plugin, err)) |
|
faluco@41
|
184 |
{ |
|
faluco@41
|
185 |
free(plugin); |
|
faluco@41
|
186 |
free(base); |
|
faluco@41
|
187 |
return NULL; |
|
faluco@41
|
188 |
} |
|
faluco@41
|
189 |
|
|
faluco@41
|
190 |
return plugin; |
|
faluco@41
|
191 |
|
|
faluco@41
|
192 |
return_error: |
|
faluco@41
|
193 |
if (err) |
|
faluco@41
|
194 |
*err = error; |
|
faluco@41
|
195 |
return NULL; |
|
faluco@41
|
196 |
} |
|
faluco@41
|
197 |
|
|
faluco@41
|
198 |
sp_plugin_t *SP_LoadFromMemory(void *base, sp_plugin_t *plugin, int *err) |
|
faluco@41
|
199 |
{ |
|
faluco@41
|
200 |
sp_file_hdr_t hdr; |
|
faluco@41
|
201 |
uint8_t noptr = 0; |
|
faluco@41
|
202 |
|
|
faluco@41
|
203 |
memcpy(&hdr, base, sizeof(sp_file_hdr_t)); |
|
faluco@41
|
204 |
|
|
faluco@41
|
205 |
if (!plugin) |
|
faluco@41
|
206 |
{ |
|
faluco@41
|
207 |
plugin = (sp_plugin_t *)malloc(sizeof(sp_plugin_t)); |
|
faluco@41
|
208 |
noptr = 1; |
|
faluco@41
|
209 |
} |
|
faluco@41
|
210 |
|
|
faluco@41
|
211 |
if (!_ReadPlugin(&hdr, base, plugin, err)) |
|
faluco@41
|
212 |
{ |
|
faluco@41
|
213 |
if (noptr) |
|
faluco@41
|
214 |
free(plugin); |
|
faluco@41
|
215 |
return NULL; |
|
faluco@41
|
216 |
} |
|
faluco@41
|
217 |
|
|
faluco@41
|
218 |
return plugin; |
|
faluco@41
|
219 |
} |