|
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