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
180
181
use crate::result::*;
use core::mem;
use core::ptr;
pub mod rc;
#[derive(Copy, Clone, PartialEq, Eq, Debug, Default)]
#[repr(C)]
pub struct ParcelHeader {
pub payload_size: u32,
pub payload_offset: u32,
pub objects_size: u32,
pub objects_offset: u32
}
impl ParcelHeader {
pub const fn new() -> Self {
Self { payload_size: 0, payload_offset: 0, objects_size: 0, objects_offset: 0 }
}
}
const PAYLOAD_SIZE: usize = 0x200;
#[derive(Copy, Clone)]
#[repr(C)]
pub struct ParcelPayload {
pub header: ParcelHeader,
pub payload: [u8; PAYLOAD_SIZE]
}
impl ParcelPayload {
pub const fn new() -> Self {
Self { header: ParcelHeader::new(), payload: [0; PAYLOAD_SIZE] }
}
}
#[derive(Copy, Clone, PartialEq, Eq, Debug, Default)]
#[repr(C)]
pub struct ParcelData {
pub parcel_type: u32,
pub unk: u32,
pub handle: i32,
pub zero: [u8; 0xC],
pub dispdrv: [u8; 8],
pub zero_2: [u8; 8],
}
pub struct Parcel {
payload: ParcelPayload,
read_offset: usize,
write_offset: usize
}
impl Parcel {
pub const fn new() -> Self {
Self { payload: ParcelPayload::new(), read_offset: 0, write_offset: 0 }
}
pub fn read_raw_unaligned(&mut self, out_data: *mut u8, data_size: usize) -> Result<()> {
result_return_if!((self.read_offset + data_size) > PAYLOAD_SIZE, rc::ResultNotEnoughReadSpace);
unsafe {
ptr::copy((&mut self.payload.payload as *mut _ as *mut u8).add(self.read_offset), out_data, data_size);
}
self.read_offset += data_size;
Ok(())
}
pub fn read_raw(&mut self, out_data: *mut u8, data_size: usize) -> Result<()> {
self.read_raw_unaligned(out_data, (data_size + 3) & !3)
}
pub fn write_raw_unaligned(&mut self, data: *const u8, data_size: usize) -> Result<()> {
result_return_if!((self.write_offset + data_size) > PAYLOAD_SIZE, rc::ResultNotEnoughWriteSpace);
unsafe {
ptr::copy(data, (&mut self.payload.payload as *mut _ as *mut u8).add(self.write_offset), data_size);
}
self.write_offset += data_size;
Ok(())
}
pub fn write_reserve_raw(&mut self, data_size: usize) -> Result<*mut u8> {
let actual_size = (data_size + 3) & !3;
result_return_if!((self.write_offset + actual_size) > PAYLOAD_SIZE, rc::ResultNotEnoughWriteSpace);
let buf = unsafe { (&mut self.payload.payload as *mut _ as *mut u8).add(self.write_offset) };
self.write_offset += actual_size;
Ok(buf)
}
pub fn write_raw(&mut self, data: *const u8, data_size: usize) -> Result<()> {
self.write_raw_unaligned(data, (data_size + 3) & !3)
}
pub fn write_unaligned<T>(&mut self, t: T) -> Result<()> {
self.write_raw_unaligned(&t as *const T as *const u8, mem::size_of::<T>())
}
pub fn write<T>(&mut self, t: T) -> Result<()> {
self.write_raw(&t as *const T as *const u8, mem::size_of::<T>())
}
pub fn read_unaligned<T: Default>(&mut self) -> Result<T> {
let mut t: T = Default::default();
self.read_raw_unaligned(&mut t as *mut T as *mut u8, mem::size_of::<T>())?;
Ok(t)
}
pub fn read<T: Default>(&mut self) -> Result<T> {
let mut t: T = Default::default();
self.read_raw(&mut t as *mut T as *mut u8, mem::size_of::<T>())?;
Ok(t)
}
pub fn write_str(&mut self, string: &str) -> Result<()> {
let len = string.len();
self.write(len as u32)?;
let str_bytes = string.as_bytes();
let str_write_buf = self.write_reserve_raw((len + 1) * 2)? as *mut u16;
for i in 0..len {
unsafe {
let cur = str_write_buf.add(i);
*cur = str_bytes[i] as u16;
}
}
Ok(())
}
pub fn write_interface_token(&mut self, token: &str) -> Result<()> {
let value: u32 = 0x100;
self.write(value)?;
self.write_str(token)
}
pub fn read_sized_raw(&mut self, out_data: *mut u8) -> Result<usize> {
let len = self.read::<i32>()? as usize;
let fd_count = self.read::<i32>()?;
result_return_unless!(fd_count == 0, rc::ResultFdsNotSupported);
self.read_raw(out_data, len)?;
Ok(len)
}
pub fn read_sized<T: Default>(&mut self) -> Result<T> {
let mut t: T = Default::default();
let len = self.read_sized_raw(&mut t as *mut T as *mut u8)?;
result_return_unless!(len == mem::size_of::<T>(), rc::ResultReadSizeMismatch);
Ok(t)
}
pub fn write_sized_raw(&mut self, data: *const u8, data_size: usize) -> Result<()> {
let len = data_size as i32;
self.write(len)?;
let fd_count: i32 = 0;
self.write(fd_count)?;
self.write_raw(data, data_size)?;
Ok(())
}
pub fn write_sized<T>(&mut self, t: T) -> Result<()> {
self.write_sized_raw(&t as *const T as *const u8, mem::size_of::<T>())
}
pub fn load_from(&mut self, payload: ParcelPayload) {
self.payload = payload;
self.read_offset = 0;
self.write_offset = payload.header.payload_size as usize;
}
pub fn end_write(&mut self) -> Result<(ParcelPayload, usize)> {
self.payload.header.payload_size = self.write_offset as u32;
self.payload.header.payload_offset = mem::size_of::<ParcelHeader>() as u32;
let payload_len = self.payload.header.payload_offset + self.payload.header.payload_size;
self.payload.header.objects_offset = payload_len;
self.payload.header.objects_size = 0;
Ok((self.payload, payload_len as usize))
}
}