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
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
use core::slice;
use core::cmp::Ordering;
use xmas_elf::ElfFile;
use xmas_elf::program::{ProgramHeader, Type::Load, SegmentData};
use sunrise_libuser::syscalls::{self, map_process_memory};
use sunrise_libuser::types::Process;
use sunrise_libuser::mem::{find_free_address, PAGE_SIZE};
use sunrise_libkern::MemoryPermissions;
use sunrise_libutils::align_up;
use sunrise_libuser::error::{Error, LoaderError};
pub fn from_data(data: &[u8]) -> Result<ElfFile, Error> {
ElfFile::new(&data[..]).map_err(|err| {
error!("Invalid ELF: {}", err);
LoaderError::InvalidElf.into()
})
}
pub fn get_size(elf: &ElfFile<'_>) -> Result<usize, Error> {
let mut size = 0;
let mut expected_next: Option<usize> = None;
for ph in elf.program_iter().filter(|ph|
if let Ok(Load) = ph.get_type() { true } else { false })
{
let vaddr = ph.virtual_addr() as usize;
let segment_size = align_up(ph.mem_size() as usize, PAGE_SIZE);
if vaddr % PAGE_SIZE != 0 {
error!("vaddr must be page-aligned");
return Err(LoaderError::InvalidElf.into());
}
if let Some(expected_next) = expected_next {
match expected_next.cmp(&vaddr) {
Ordering::Less => {
debug!("VAddr has an offset of {} bytes", vaddr - expected_next);
size += vaddr - expected_next;
},
Ordering::Greater => {
error!("Overlapping segments: Expected segment start {:x}, got {:x}", expected_next, vaddr);
return Err(LoaderError::InvalidElf.into());
},
_ => ()
}
}
size += segment_size;
expected_next = Some(vaddr + segment_size);
}
Ok(size)
}
pub fn get_kacs<'a>(elf: &'a ElfFile<'_>) -> Option<&'a [u8]> {
elf.find_section_by_name(".kernel_caps")
.map(|section| section.raw_data(&elf))
}
pub fn load_file(process: &Process, elf: &ElfFile<'_>, base: usize) -> Result<(), Error> {
for ph in elf.program_iter().filter(|ph|
if let Ok(Load) = ph.get_type() { true } else { false })
{
load_segment(process, ph, &elf, base)?;
}
let entry_point = elf.header.pt2.entry_point() as usize;
if entry_point != 0 {
error!("Non-zero entrypoint found: {:x}!", entry_point);
return Err(LoaderError::InvalidElf.into())
}
Ok(())
}
#[allow(clippy::match_bool)]
fn load_segment(process: &Process, segment: ProgramHeader<'_>, elf_file: &ElfFile, base: usize) -> Result<(), Error> {
let mem_size_total = align_up(segment.mem_size() as usize, PAGE_SIZE);
let mut flags = MemoryPermissions::empty();
if segment.flags().is_read() {
flags |= MemoryPermissions::READABLE
}
if segment.flags().is_write() {
flags |= MemoryPermissions::WRITABLE
}
if segment.flags().is_execute() {
flags |= MemoryPermissions::EXECUTABLE
}
flags.check()?;
let elf_data = match segment.get_data(elf_file).or(Err(LoaderError::InvalidElf))?
{
SegmentData::Undefined(elf_data) => elf_data,
x => {
error!("Unexpected Segment data {:?}", x);
return Err(LoaderError::InvalidElf.into());
}
};
let virtual_addr = base + segment.virtual_addr() as usize;
let addr = find_free_address(mem_size_total, 0x1000)?;
map_process_memory(addr, process, virtual_addr, mem_size_total)?;
{
let dest_ptr = addr as *mut u8;
let dest = unsafe {
slice::from_raw_parts_mut(dest_ptr, mem_size_total)
};
let (dest_data, dest_pad) = dest.split_at_mut(segment.file_size() as usize);
dest_data.copy_from_slice(elf_data);
for byte in dest_pad.iter_mut() {
*byte = 0x00;
}
}
unsafe {
syscalls::unmap_process_memory(addr, process, virtual_addr, mem_size_total)?;
}
syscalls::set_process_memory_permission(process, virtual_addr, mem_size_total, flags)?;
info!("Loaded segment - VirtAddr {:#010x}, FileSize {:#010x}, MemSize {:#010x} {}{}{}",
virtual_addr, segment.file_size(), segment.mem_size(),
match segment.flags().is_read() { true => 'R', false => ' '},
match segment.flags().is_write() { true => 'W', false => ' '},
match segment.flags().is_execute() { true => 'X', false => ' '},
);
Ok(())
}