Add clang-format and format code to qemu code style
This commit is contained in:
@ -26,62 +26,64 @@ Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
|
||||
|
||||
#pragma pack(push, 1)
|
||||
struct SegmentDescriptor {
|
||||
union {
|
||||
struct {
|
||||
union {
|
||||
struct {
|
||||
#if __BYTE_ORDER == __LITTLE_ENDIAN
|
||||
unsigned short limit0;
|
||||
unsigned short base0;
|
||||
unsigned char base1;
|
||||
unsigned char type:4;
|
||||
unsigned char system:1; /* S flag */
|
||||
unsigned char dpl:2;
|
||||
unsigned char present:1; /* P flag */
|
||||
unsigned char limit1:4;
|
||||
unsigned char avail:1;
|
||||
unsigned char is_64_code:1; /* L flag */
|
||||
unsigned char db:1; /* DB flag */
|
||||
unsigned char granularity:1; /* G flag */
|
||||
unsigned char base2;
|
||||
unsigned short limit0;
|
||||
unsigned short base0;
|
||||
unsigned char base1;
|
||||
unsigned char type : 4;
|
||||
unsigned char system : 1; /* S flag */
|
||||
unsigned char dpl : 2;
|
||||
unsigned char present : 1; /* P flag */
|
||||
unsigned char limit1 : 4;
|
||||
unsigned char avail : 1;
|
||||
unsigned char is_64_code : 1; /* L flag */
|
||||
unsigned char db : 1; /* DB flag */
|
||||
unsigned char granularity : 1; /* G flag */
|
||||
unsigned char base2;
|
||||
#else
|
||||
unsigned char base2;
|
||||
unsigned char granularity:1; /* G flag */
|
||||
unsigned char db:1; /* DB flag */
|
||||
unsigned char is_64_code:1; /* L flag */
|
||||
unsigned char avail:1;
|
||||
unsigned char limit1:4;
|
||||
unsigned char present:1; /* P flag */
|
||||
unsigned char dpl:2;
|
||||
unsigned char system:1; /* S flag */
|
||||
unsigned char type:4;
|
||||
unsigned char base1;
|
||||
unsigned short base0;
|
||||
unsigned short limit0;
|
||||
unsigned char base2;
|
||||
unsigned char granularity : 1; /* G flag */
|
||||
unsigned char db : 1; /* DB flag */
|
||||
unsigned char is_64_code : 1; /* L flag */
|
||||
unsigned char avail : 1;
|
||||
unsigned char limit1 : 4;
|
||||
unsigned char present : 1; /* P flag */
|
||||
unsigned char dpl : 2;
|
||||
unsigned char system : 1; /* S flag */
|
||||
unsigned char type : 4;
|
||||
unsigned char base1;
|
||||
unsigned short base0;
|
||||
unsigned short limit0;
|
||||
#endif
|
||||
};
|
||||
uint64_t desc;
|
||||
};
|
||||
};
|
||||
uint64_t desc;
|
||||
};
|
||||
};
|
||||
#pragma pack(pop)
|
||||
|
||||
#define SEGBASE(d) ((uint32_t)((((d).desc >> 16) & 0xffffff) | (((d).desc >> 32) & 0xff000000)))
|
||||
#define SEGBASE(d) \
|
||||
((uint32_t)((((d).desc >> 16) & 0xffffff) | \
|
||||
(((d).desc >> 32) & 0xff000000)))
|
||||
#define SEGLIMIT(d) ((d).limit0 | (((unsigned int)(d).limit1) << 16))
|
||||
|
||||
/**
|
||||
* Assert that err matches expect
|
||||
*/
|
||||
#define uc_assert_err(expect, err) \
|
||||
do { \
|
||||
uc_err __err = err; \
|
||||
if (__err != expect) { \
|
||||
fprintf(stderr, "%s", uc_strerror(__err)); \
|
||||
exit(1); \
|
||||
} \
|
||||
} while (0)
|
||||
#define uc_assert_err(expect, err) \
|
||||
do { \
|
||||
uc_err __err = err; \
|
||||
if (__err != expect) { \
|
||||
fprintf(stderr, "%s", uc_strerror(__err)); \
|
||||
exit(1); \
|
||||
} \
|
||||
} while (0)
|
||||
|
||||
/**
|
||||
* Assert that err is UC_ERR_OK
|
||||
*/
|
||||
#define uc_assert_success(err) uc_assert_err(UC_ERR_OK, err)
|
||||
#define uc_assert_success(err) uc_assert_err(UC_ERR_OK, err)
|
||||
|
||||
/**
|
||||
* Assert that err is anything but UC_ERR_OK
|
||||
@ -90,55 +92,61 @@ do { \
|
||||
* as this serves to document which errors a function will return
|
||||
* in various scenarios.
|
||||
*/
|
||||
#define uc_assert_fail(err) \
|
||||
do { \
|
||||
uc_err __err = err; \
|
||||
if (__err == UC_ERR_OK) { \
|
||||
fprintf(stderr, "%s", uc_strerror(__err)); \
|
||||
exit(1); \
|
||||
} \
|
||||
} while (0)
|
||||
#define uc_assert_fail(err) \
|
||||
do { \
|
||||
uc_err __err = err; \
|
||||
if (__err == UC_ERR_OK) { \
|
||||
fprintf(stderr, "%s", uc_strerror(__err)); \
|
||||
exit(1); \
|
||||
} \
|
||||
} while (0)
|
||||
|
||||
#define OK(x) uc_assert_success(x)
|
||||
#define OK(x) uc_assert_success(x)
|
||||
|
||||
/******************************************************************************/
|
||||
|
||||
static void hook_mem(uc_engine *uc, uc_mem_type type, uint64_t address, int size, int64_t value, void *user_data)
|
||||
static void hook_mem(uc_engine *uc, uc_mem_type type, uint64_t address,
|
||||
int size, int64_t value, void *user_data)
|
||||
{
|
||||
switch(type) {
|
||||
case UC_MEM_WRITE:
|
||||
printf("mem write at 0x%"PRIx64 ", size = %u, value = 0x%"PRIx64 "\n", address, size, value);
|
||||
break;
|
||||
default: break;
|
||||
switch (type) {
|
||||
case UC_MEM_WRITE:
|
||||
printf("mem write at 0x%" PRIx64 ", size = %u, value = 0x%" PRIx64 "\n",
|
||||
address, size, value);
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
static void hook_code(uc_engine *uc, uint64_t address, uint32_t size, void *user_data)
|
||||
static void hook_code(uc_engine *uc, uint64_t address, uint32_t size,
|
||||
void *user_data)
|
||||
{
|
||||
printf("Executing at 0x%"PRIx64 ", ilen = 0x%x\n", address, size);
|
||||
printf("Executing at 0x%" PRIx64 ", ilen = 0x%x\n", address, size);
|
||||
}
|
||||
|
||||
//VERY basic descriptor init function, sets many fields to user space sane defaults
|
||||
static void init_descriptor(struct SegmentDescriptor *desc, uint32_t base, uint32_t limit, uint8_t is_code)
|
||||
// VERY basic descriptor init function, sets many fields to user space sane
|
||||
// defaults
|
||||
static void init_descriptor(struct SegmentDescriptor *desc, uint32_t base,
|
||||
uint32_t limit, uint8_t is_code)
|
||||
{
|
||||
desc->desc = 0; //clear the descriptor
|
||||
desc->desc = 0; // clear the descriptor
|
||||
desc->base0 = base & 0xffff;
|
||||
desc->base1 = (base >> 16) & 0xff;
|
||||
desc->base2 = base >> 24;
|
||||
if (limit > 0xfffff) {
|
||||
//need Giant granularity
|
||||
// need Giant granularity
|
||||
limit >>= 12;
|
||||
desc->granularity = 1;
|
||||
}
|
||||
desc->limit0 = limit & 0xffff;
|
||||
desc->limit1 = limit >> 16;
|
||||
|
||||
//some sane defaults
|
||||
// some sane defaults
|
||||
desc->dpl = 3;
|
||||
desc->present = 1;
|
||||
desc->db = 1; //32 bit
|
||||
desc->db = 1; // 32 bit
|
||||
desc->type = is_code ? 0xb : 3;
|
||||
desc->system = 1; //code or data
|
||||
desc->system = 1; // code or data
|
||||
}
|
||||
|
||||
/*
|
||||
@ -149,7 +157,7 @@ static void hex_dump(unsigned char *ptr, unsigned int len)
|
||||
if (i != 0 && (i & 0xf) == 0) {
|
||||
fprintf(stderr, "\n");
|
||||
}
|
||||
fprintf(stderr, "%02hhx", ptr[i]);
|
||||
fprintf(stderr, "%02hhx", ptr[i]);
|
||||
}
|
||||
fprintf(stderr, "\n");
|
||||
}
|
||||
@ -163,7 +171,7 @@ static void gdt_demo()
|
||||
uint8_t buf[128];
|
||||
uc_x86_mmr gdtr;
|
||||
int i;
|
||||
|
||||
|
||||
/*
|
||||
bits 32
|
||||
|
||||
@ -174,29 +182,33 @@ static void gdt_demo()
|
||||
mov dword [fs:4], 0x89abcdef
|
||||
*/
|
||||
|
||||
const uint8_t code[] = "\x68\x67\x45\x23\x01\x68\xef\xcd\xab\x89\x64\xc7\x05\x00\x00\x00\x00\x67\x45\x23\x01\x64\xc7\x05\x04\x00\x00\x00\xef\xcd\xab\x89";
|
||||
const uint8_t code[] =
|
||||
"\x68\x67\x45\x23\x01\x68\xef\xcd\xab\x89\x64\xc7\x05\x00\x00\x00\x00"
|
||||
"\x67\x45\x23\x01\x64\xc7\x05\x04\x00\x00\x00\xef\xcd\xab\x89";
|
||||
const uint64_t code_address = 0x1000000;
|
||||
const uint64_t stack_address = 0x120000;
|
||||
const uint64_t gdt_address = 0xc0000000;
|
||||
const uint64_t fs_address = 0x7efdd000;
|
||||
|
||||
struct SegmentDescriptor *gdt = (struct SegmentDescriptor*)calloc(31, sizeof(struct SegmentDescriptor));
|
||||
struct SegmentDescriptor *gdt = (struct SegmentDescriptor *)calloc(
|
||||
31, sizeof(struct SegmentDescriptor));
|
||||
|
||||
int r_esp = (int)stack_address + 0x1000; // initial esp
|
||||
int r_esp = (int)stack_address + 0x1000; // initial esp
|
||||
int r_cs = 0x73;
|
||||
int r_ss = 0x88; //ring 0
|
||||
int r_ss = 0x88; // ring 0
|
||||
int r_ds = 0x7b;
|
||||
int r_es = 0x7b;
|
||||
int r_fs = 0x83;
|
||||
|
||||
gdtr.base = gdt_address;
|
||||
gdtr.base = gdt_address;
|
||||
gdtr.limit = 31 * sizeof(struct SegmentDescriptor) - 1;
|
||||
|
||||
init_descriptor(&gdt[14], 0, 0xfffff000, 1); //code segment
|
||||
init_descriptor(&gdt[15], 0, 0xfffff000, 0); //data segment
|
||||
init_descriptor(&gdt[16], 0x7efdd000, 0xfff, 0); //one page data segment simulate fs
|
||||
init_descriptor(&gdt[17], 0, 0xfffff000, 0); //ring 0 data
|
||||
gdt[17].dpl = 0; //set descriptor privilege level
|
||||
init_descriptor(&gdt[14], 0, 0xfffff000, 1); // code segment
|
||||
init_descriptor(&gdt[15], 0, 0xfffff000, 0); // data segment
|
||||
init_descriptor(&gdt[16], 0x7efdd000, 0xfff,
|
||||
0); // one page data segment simulate fs
|
||||
init_descriptor(&gdt[17], 0, 0xfffff000, 0); // ring 0 data
|
||||
gdt[17].dpl = 0; // set descriptor privilege level
|
||||
|
||||
/*
|
||||
fprintf(stderr, "GDT: \n");
|
||||
@ -207,9 +219,11 @@ static void gdt_demo()
|
||||
err = uc_open(UC_ARCH_X86, UC_MODE_32, &uc);
|
||||
uc_assert_success(err);
|
||||
|
||||
uc_hook_add(uc, &hook1, UC_HOOK_CODE, hook_code, NULL, code_address, code_address + sizeof(code) - 1);
|
||||
uc_hook_add(uc, &hook1, UC_HOOK_CODE, hook_code, NULL, code_address,
|
||||
code_address + sizeof(code) - 1);
|
||||
|
||||
err = uc_hook_add(uc, &hook2, UC_HOOK_MEM_WRITE, hook_mem, NULL, (uint64_t)1, (uint64_t)0);
|
||||
err = uc_hook_add(uc, &hook2, UC_HOOK_MEM_WRITE, hook_mem, NULL,
|
||||
(uint64_t)1, (uint64_t)0);
|
||||
uc_assert_success(err);
|
||||
|
||||
// map 1 page of code for this emulation
|
||||
@ -224,12 +238,13 @@ static void gdt_demo()
|
||||
err = uc_mem_map(uc, gdt_address, 0x10000, UC_PROT_WRITE | UC_PROT_READ);
|
||||
uc_assert_success(err);
|
||||
|
||||
//set up a GDT BEFORE you manipulate any segment registers
|
||||
// set up a GDT BEFORE you manipulate any segment registers
|
||||
err = uc_reg_write(uc, UC_X86_REG_GDTR, &gdtr);
|
||||
uc_assert_success(err);
|
||||
|
||||
// write gdt to be emulated to memory
|
||||
err = uc_mem_write(uc, gdt_address, gdt, 31 * sizeof(struct SegmentDescriptor));
|
||||
err = uc_mem_write(uc, gdt_address, gdt,
|
||||
31 * sizeof(struct SegmentDescriptor));
|
||||
uc_assert_success(err);
|
||||
|
||||
// map 1 page for FS
|
||||
@ -237,7 +252,7 @@ static void gdt_demo()
|
||||
uc_assert_success(err);
|
||||
|
||||
// write machine code to be emulated to memory
|
||||
err = uc_mem_write(uc, code_address, code, sizeof(code)-1);
|
||||
err = uc_mem_write(uc, code_address, code, sizeof(code) - 1);
|
||||
uc_assert_success(err);
|
||||
|
||||
// initialize machine registers
|
||||
@ -245,7 +260,8 @@ static void gdt_demo()
|
||||
uc_assert_success(err);
|
||||
|
||||
// when setting SS, need rpl == cpl && dpl == cpl
|
||||
// emulator starts with cpl == 0, so we need a dpl 0 descriptor and rpl 0 selector
|
||||
// emulator starts with cpl == 0, so we need a dpl 0 descriptor and rpl 0
|
||||
// selector
|
||||
err = uc_reg_write(uc, UC_X86_REG_SS, &r_ss);
|
||||
uc_assert_success(err);
|
||||
|
||||
@ -259,7 +275,7 @@ static void gdt_demo()
|
||||
uc_assert_success(err);
|
||||
|
||||
// emulate machine code in infinite time
|
||||
err = uc_emu_start(uc, code_address, code_address+sizeof(code)-1, 0, 0);
|
||||
err = uc_emu_start(uc, code_address, code_address + sizeof(code) - 1, 0, 0);
|
||||
uc_assert_success(err);
|
||||
|
||||
// read from memory
|
||||
|
Reference in New Issue
Block a user