|
1 | | -use core::arch::asm; |
2 | | -use core::{mem, ptr}; |
| 1 | +use core::mem; |
| 2 | + |
| 3 | +type Reg = core::mem::MaybeUninit<usize>; |
| 4 | + |
| 5 | +#[unsafe(naked)] |
| 6 | +pub unsafe extern "C" fn call_with_kernel_stack( |
| 7 | + x0: Reg, |
| 8 | + x1: Reg, |
| 9 | + x2: Reg, |
| 10 | + x3: Reg, |
| 11 | + x4: Reg, |
| 12 | + x5: Reg, |
| 13 | + f: unsafe extern "C" fn(x0: Reg, x1: Reg, x2: Reg, x3: Reg, x4: Reg, x5: Reg) -> Reg, |
| 14 | +) -> Reg { |
| 15 | + core::arch::naked_asm!( |
| 16 | + // Disable IRQs and FIQs while changing stack pointer |
| 17 | + "msr daifset, #0b11", |
| 18 | + // Preserve return address on the stack |
| 19 | + "str x30, [sp, #-16]!", |
| 20 | + // Switch to kernel stack |
| 21 | + "msr spsel, #1", |
| 22 | + // Re-enable IRQs and FIQs |
| 23 | + "msr daifclr, #0b11", |
| 24 | + // Call the function pointer (stored in x6) |
| 25 | + "blr x6", |
| 26 | + // Disable IRQs and FIQs before restoring stack |
| 27 | + "msr daifset, #0b11", |
| 28 | + // Switch back to user stack |
| 29 | + "msr spsel, #0", |
| 30 | + // Restore return address from the stack |
| 31 | + "ldr x30, [sp], 16", |
| 32 | + // Re-enable IRQs and FIQs |
| 33 | + "msr daifclr, #0b11", |
| 34 | + // Return to caller (return value is in x0) |
| 35 | + "ret", |
| 36 | + ) |
| 37 | +} |
3 | 38 |
|
4 | 39 | macro_rules! kernel_function_impl { |
5 | | - ($kernel_function:ident($($arg:ident: $A:ident),*) { $($operands:tt)* }) => { |
| 40 | + ($kernel_function:ident($($arg:ident: $A:ident),*; $($z:ident: Reg),*)) => { |
6 | 41 | /// Executes `f` on the kernel stack. |
7 | 42 | #[allow(dead_code)] |
8 | | - pub unsafe fn $kernel_function<R, $($A),*>(f: unsafe extern "C" fn($($A),*) -> R, $($arg: $A),*) -> R { |
| 43 | + #[inline] |
| 44 | + pub unsafe extern "C" fn $kernel_function<R, $($A),*>($($arg: $A,)* f: unsafe extern "C" fn($($A),*) -> R) -> R { |
9 | 45 | unsafe { |
10 | | - assert!(mem::size_of::<R>() <= mem::size_of::<usize>()); |
11 | | - |
12 | 46 | $( |
13 | | - assert!(mem::size_of::<$A>() <= mem::size_of::<usize>()); |
14 | | - let $arg = { |
15 | | - let mut reg = 0usize; |
16 | | - // SAFETY: $A is smaller than usize and directly fits in a register |
17 | | - // Since f takes $A as argument via C calling convention, any upper bytes do not matter. |
18 | | - ptr::write(ptr::from_mut(&mut reg).cast(), $arg); |
19 | | - reg |
20 | | - }; |
| 47 | + assert!(mem::size_of::<$A>() <= mem::size_of::<Reg>()); |
21 | 48 | )* |
| 49 | + assert!(mem::size_of::<R>() <= mem::size_of::<Reg>()); |
22 | 50 |
|
23 | | - let ret: u64; |
24 | | - asm!( |
25 | | - // Switch to kernel stack |
26 | | - "msr spsel, {l1}", |
27 | | - |
28 | | - // To make sure, Rust manages the stack in `f` correctly, |
29 | | - // we keep all arguments and return values in registers |
30 | | - // until we switch the stack back. Thus follows the sizing |
31 | | - // requirements for arguments and return types. |
32 | | - "blr {f}", |
33 | | - |
34 | | - // Switch back to user stack |
35 | | - "msr spsel, {l0}", |
| 51 | + let call_with_kernel_stack = mem::transmute::<*const (), unsafe extern "C" fn( |
| 52 | + $($arg: $A,)* |
| 53 | + $($z: Reg,)* |
| 54 | + f: unsafe extern "C" fn( |
| 55 | + $($arg: $A,)* |
| 56 | + ) -> R, |
| 57 | + ) -> R>(call_with_kernel_stack as *const ()); |
36 | 58 |
|
37 | | - l0 = const 0, |
38 | | - l1 = const 1, |
39 | | - f = in(reg) f, |
40 | | - |
41 | | - $($operands)* |
42 | | - |
43 | | - // Return argument in x0 |
44 | | - lateout("x0") ret, |
45 | | - |
46 | | - clobber_abi("C"), |
47 | | - ); |
| 59 | + $( |
| 60 | + let $z = Reg::uninit(); |
| 61 | + )* |
48 | 62 |
|
49 | | - // SAFETY: R is smaller than usize and directly fits in rax |
50 | | - // Since f returns R, we can safely convert ret to R |
51 | | - mem::transmute_copy(&ret) |
| 63 | + call_with_kernel_stack( |
| 64 | + $($arg,)* |
| 65 | + $($z,)* |
| 66 | + f, |
| 67 | + ) |
52 | 68 | } |
53 | 69 | } |
54 | 70 | }; |
55 | 71 | } |
56 | 72 |
|
57 | | -kernel_function_impl!(kernel_function0() {}); |
58 | | - |
59 | | -kernel_function_impl!(kernel_function1(arg1: A1) { |
60 | | - in("x0") arg1, |
61 | | -}); |
62 | | - |
63 | | -kernel_function_impl!(kernel_function2(arg1: A1, arg2: A2) { |
64 | | - in("x0") arg1, |
65 | | - in("x1") arg2, |
66 | | -}); |
67 | | - |
68 | | -kernel_function_impl!(kernel_function3(arg1: A1, arg2: A2, arg3: A3) { |
69 | | - in("x0") arg1, |
70 | | - in("x1") arg2, |
71 | | - in("x2") arg3, |
72 | | -}); |
73 | | - |
74 | | -kernel_function_impl!(kernel_function4(arg1: A1, arg2: A2, arg3: A3, arg4: A4) { |
75 | | - in("x0") arg1, |
76 | | - in("x1") arg2, |
77 | | - in("x2") arg3, |
78 | | - in("x3") arg4, |
79 | | -}); |
80 | | - |
81 | | -kernel_function_impl!(kernel_function5(arg1: A1, arg2: A2, arg3: A3, arg4: A4, arg5: A5) { |
82 | | - in("x0") arg1, |
83 | | - in("x1") arg2, |
84 | | - in("x2") arg3, |
85 | | - in("x3") arg4, |
86 | | - in("x4") arg5, |
87 | | -}); |
88 | | - |
89 | | -kernel_function_impl!(kernel_function6(arg1: A1, arg2: A2, arg3: A3, arg4: A4, arg5: A5, arg6: A6) { |
90 | | - in("x0") arg1, |
91 | | - in("x1") arg2, |
92 | | - in("x2") arg3, |
93 | | - in("x3") arg4, |
94 | | - in("x4") arg5, |
95 | | - in("x5") arg6, |
96 | | -}); |
| 73 | +kernel_function_impl!(kernel_function0(; u1: Reg, u2: Reg, u3: Reg, u4: Reg, u5: Reg, u6: Reg)); |
| 74 | +kernel_function_impl!(kernel_function1(arg1: A1; u2: Reg, u3: Reg, u4: Reg, u5: Reg, u6: Reg)); |
| 75 | +kernel_function_impl!(kernel_function2(arg1: A1, arg2: A2; u3: Reg, u4: Reg, u5: Reg, u6: Reg)); |
| 76 | +kernel_function_impl!(kernel_function3(arg1: A1, arg2: A2, arg3: A3; u4: Reg, u5: Reg, u6: Reg)); |
| 77 | +kernel_function_impl!(kernel_function4(arg1: A1, arg2: A2, arg3: A3, arg4: A4; u5: Reg, u6: Reg)); |
| 78 | +kernel_function_impl!(kernel_function5(arg1: A1, arg2: A2, arg3: A3, arg4: A4, arg5: A5; u6: Reg)); |
| 79 | +kernel_function_impl!(kernel_function6(arg1: A1, arg2: A2, arg3: A3, arg4: A4, arg5: A5, arg6: A6; )); |
0 commit comments