1use crate::signals::{SignalInfo, SignalState};
6use crate::task::{ArchExtendedPstateStorage, CurrentTask, Task};
7use starnix_logging::log_debug;
8use starnix_registers::{RegisterState, RegisterStorageEnum};
9use starnix_types::arch::ArchWidth;
10use starnix_uapi::errors::Errno;
11use starnix_uapi::signals::SigSet;
12use starnix_uapi::user_address::UserAddress;
13use starnix_uapi::{
14 self as uapi, error, sigaction_t, sigaltstack, sigcontext, siginfo_t, ucontext,
15};
16use static_assertions::const_assert_eq;
17
18pub const RED_ZONE_SIZE: u64 = 128;
29
30#[repr(C)]
37pub struct SignalStackFrame {
38 restorer_address: u64,
42
43 pub siginfo_bytes: [u8; std::mem::size_of::<siginfo_t>()],
45
46 pub context: ucontext,
48
49 xstate: XState,
51}
52
53#[repr(C, packed)]
61struct XState {
62 base_xstate: uapi::_xstate,
63
64 xstate_magic2: u32,
66}
67
68const_assert_eq!(
70 std::mem::size_of::<XState>(),
71 std::mem::size_of::<uapi::_xstate>() + std::mem::size_of::<u32>()
72);
73
74pub const SIG_STACK_SIZE: usize = std::mem::size_of::<SignalStackFrame>();
75
76impl SignalStackFrame {
77 pub fn new(
78 _task: &Task,
79 arch_width: ArchWidth,
80 registers: &RegisterState<RegisterStorageEnum>,
81 extended_pstate: &ArchExtendedPstateStorage,
82 signal_state: &SignalState,
83 siginfo: &SignalInfo,
84 action: sigaction_t,
85 stack_pointer: UserAddress,
86 ) -> Result<SignalStackFrame, Errno> {
87 let fpstate_addr = (uapi::uaddr {
88 addr: stack_pointer.ptr() as u64
89 + memoffset::offset_of!(SignalStackFrame, xstate) as u64,
90 })
91 .into();
92 let context = ucontext {
93 uc_mcontext: sigcontext {
94 r8: registers.r8,
95 r9: registers.r9,
96 r10: registers.r10,
97 r11: registers.r11,
98 r12: registers.r12,
99 r13: registers.r13,
100 r14: registers.r14,
101 r15: registers.r15,
102 rdi: registers.rdi,
103 rsi: registers.rsi,
104 rbp: registers.rbp,
105 rbx: registers.rbx,
106 rdx: registers.rdx,
107 rax: registers.rax,
108 rcx: registers.rcx,
109 rsp: registers.rsp,
110 rip: registers.ip,
111 eflags: registers.flags,
112 oldmask: signal_state.mask().into(),
113 fpstate: fpstate_addr,
114 ..Default::default()
115 },
116 uc_stack: signal_state
117 .alt_stack
118 .map(|stack| sigaltstack {
119 ss_sp: stack.ss_sp.into(),
120 ss_flags: stack.ss_flags as i32,
121 ss_size: stack.ss_size as u64,
122 ..Default::default()
123 })
124 .unwrap_or_default(),
125 uc_sigmask: signal_state.mask().into(),
126 ..Default::default()
127 };
128 Ok(SignalStackFrame {
129 context,
130 siginfo_bytes: siginfo.as_siginfo_bytes(arch_width)?,
131 restorer_address: action.sa_restorer.addr,
132 xstate: get_xstate(extended_pstate),
133 })
134 }
135
136 pub fn as_bytes(&self) -> &[u8; SIG_STACK_SIZE] {
137 #[allow(
138 clippy::undocumented_unsafe_blocks,
139 reason = "Force documented unsafe blocks in Starnix"
140 )]
141 unsafe {
142 std::mem::transmute(self)
143 }
144 }
145
146 pub fn from_bytes(bytes: [u8; SIG_STACK_SIZE]) -> SignalStackFrame {
147 #[allow(
148 clippy::undocumented_unsafe_blocks,
149 reason = "Force documented unsafe blocks in Starnix"
150 )]
151 unsafe {
152 std::mem::transmute(bytes)
153 }
154 }
155
156 pub fn get_signal_mask(&self, _is_arch32: bool) -> SigSet {
157 self.context.uc_sigmask.into()
158 }
159}
160
161pub fn align_stack_pointer(pointer: u64) -> u64 {
167 pointer - (pointer % 16 + 8)
168}
169
170fn get_xstate(extended_pstate: &ArchExtendedPstateStorage) -> XState {
171 let extended_pstate = match extended_pstate {
172 ArchExtendedPstateStorage::State64(extended_pstate) => extended_pstate,
173 };
174 const_assert_eq!(std::mem::size_of::<uapi::_xstate>(), extended_pstate::X64_XSAVE_AREA_SIZE);
175
176 #[allow(
177 clippy::undocumented_unsafe_blocks,
178 reason = "Force documented unsafe blocks in Starnix"
179 )]
180 let mut xstate = XState {
181 base_xstate: unsafe { std::mem::transmute(extended_pstate.get_x64_xsave_area()) },
183 xstate_magic2: uapi::FP_XSTATE_MAGIC2,
184 };
185
186 xstate.base_xstate.fpstate.__bindgen_anon_1.sw_reserved = uapi::_fpx_sw_bytes {
187 magic1: uapi::FP_XSTATE_MAGIC1,
192 extended_size: std::mem::size_of::<XState>() as u32,
193 xfeatures: extended_pstate::X64_SUPPORTED_XSAVE_FEATURES,
195 xstate_size: std::mem::size_of::<uapi::_xstate>() as u32,
196 ..Default::default()
197 };
198
199 xstate
200}
201
202pub fn restore_registers(
203 current_task: &mut CurrentTask,
204 signal_stack_frame: &SignalStackFrame,
205 _stack_pointer: UserAddress,
206) -> Result<(), Errno> {
207 let uctx = &signal_stack_frame.context.uc_mcontext;
208 let restored_regs = zx::sys::zx_restricted_state_t {
210 r8: uctx.r8,
211 r9: uctx.r9,
212 r10: uctx.r10,
213 r11: uctx.r11,
214 r12: uctx.r12,
215 r13: uctx.r13,
216 r14: uctx.r14,
217 r15: uctx.r15,
218 rax: uctx.rax,
219 rbx: uctx.rbx,
220 rcx: uctx.rcx,
221 rdx: uctx.rdx,
222 rsi: uctx.rsi,
223 rdi: uctx.rdi,
224 rbp: uctx.rbp,
225 rsp: uctx.rsp,
226 ip: uctx.rip,
227 flags: uctx.eflags,
228 fs_base: current_task.thread_state.registers.fs_base,
229 gs_base: current_task.thread_state.registers.gs_base,
230 };
231 current_task.thread_state.registers.load(restored_regs);
232
233 let xstate = &signal_stack_frame.xstate;
234 #[allow(
235 clippy::undocumented_unsafe_blocks,
236 reason = "Force documented unsafe blocks in Starnix"
237 )]
238 let fpx_sw_bytes = unsafe { xstate.base_xstate.fpstate.__bindgen_anon_1.sw_reserved };
239 if fpx_sw_bytes.magic1 != uapi::FP_XSTATE_MAGIC1
240 || fpx_sw_bytes.extended_size != std::mem::size_of::<XState>() as u32
241 || fpx_sw_bytes.xfeatures != extended_pstate::X64_SUPPORTED_XSAVE_FEATURES
242 || fpx_sw_bytes.xstate_size != std::mem::size_of::<uapi::_xstate>() as u32
243 || xstate.xstate_magic2 != uapi::FP_XSTATE_MAGIC2
244 {
245 log_debug!("Invalid xstate found in signal stack frame.");
246 return error!(EINVAL);
247 }
248
249 let extended_pstate = match &mut current_task.thread_state.extended_pstate {
250 ArchExtendedPstateStorage::State64(state) => state,
251 };
252 #[allow(
253 clippy::undocumented_unsafe_blocks,
254 reason = "Force documented unsafe blocks in Starnix"
255 )]
256 extended_pstate.set_x64_xsave_area(unsafe { std::mem::transmute(xstate.base_xstate) });
257
258 Ok(())
259}
260
261#[cfg(test)]
262mod tests {
263 use super::*;
264 use crate::mm::memory::MemoryObject;
265 use crate::mm::{DesiredAddress, MappingName, MappingOptions, ProtectionFlags};
266 use crate::signals::{SignalDetail, dequeue_signal, restore_from_signal_handler};
267 use crate::task::CurrentTask;
268 use crate::testing::spawn_kernel_and_run;
269 use starnix_uapi::errors::{EINTR, ERESTARTSYS};
270 use starnix_uapi::signals::{SIGUSR1, SIGUSR2};
271 use starnix_uapi::{__NR_rt_sigreturn, SA_RESTART, SA_RESTORER, SA_SIGINFO, SI_USER};
272 use std::future::Future;
273
274 const SYSCALL_INSTRUCTION_ADDRESS: UserAddress = UserAddress::const_from(100);
275 const SYSCALL_NUMBER: u64 = 42;
276 const SYSCALL_ARGS: (u64, u64, u64, u64, u64, u64) = (20, 21, 22, 23, 24, 25);
277 const SA_RESTORER_ADDRESS: UserAddress = UserAddress::const_from(0xDEADBEEF);
278 const SA_HANDLER_ADDRESS: UserAddress = UserAddress::const_from(0x00BADDAD);
279
280 const SYSCALL2_INSTRUCTION_ADDRESS: UserAddress = UserAddress::const_from(200);
281 const SYSCALL2_NUMBER: u64 = 84;
282 const SYSCALL2_ARGS: (u64, u64, u64, u64, u64, u64) = (30, 31, 32, 33, 34, 35);
283 const SA_HANDLER2_ADDRESS: UserAddress = UserAddress::const_from(0xBADDAD00);
284
285 #[fuchsia::test]
286 async fn syscall_restart_adjusts_instruction_pointer_and_rax() {
287 spawn_kernel_and_run_with_stack(|current_task| {
288 current_task.thread_group().signal_actions.set(
290 SIGUSR1,
291 sigaction_t {
292 sa_flags: (SA_RESTORER | SA_RESTART | SA_SIGINFO) as u64,
293 sa_handler: SA_HANDLER_ADDRESS.into(),
294 sa_restorer: SA_RESTORER_ADDRESS.into(),
295 ..sigaction_t::default()
296 },
297 );
298
299 current_task.thread_state.restart_code = Some(ERESTARTSYS);
305 current_task.thread_state.registers.rax = ERESTARTSYS.return_value();
306 current_task.thread_state.registers.rdi = SYSCALL_ARGS.0;
307 current_task.thread_state.registers.rsi = SYSCALL_ARGS.1;
308 current_task.thread_state.registers.rdx = SYSCALL_ARGS.2;
309 current_task.thread_state.registers.r10 = SYSCALL_ARGS.3;
310 current_task.thread_state.registers.r8 = SYSCALL_ARGS.4;
311 current_task.thread_state.registers.r9 = SYSCALL_ARGS.5;
312 current_task.thread_state.registers.orig_rax = SYSCALL_NUMBER;
313 current_task.thread_state.registers.ip =
314 (SYSCALL_INSTRUCTION_ADDRESS + 2u64).unwrap().ptr() as u64;
315
316 current_task.write().enqueue_signal(SignalInfo::with_detail(
318 SIGUSR1,
319 SI_USER as i32,
320 SignalDetail::None,
321 ));
322
323 dequeue_signal(current_task);
325
326 assert_eq!(current_task.thread_state.registers.ip, SA_HANDLER_ADDRESS.ptr() as u64);
328
329 assert_ne!(current_task.thread_state.registers.rdi, SYSCALL_ARGS.0);
331 assert_ne!(current_task.thread_state.registers.rsi, SYSCALL_ARGS.1);
332 assert_ne!(current_task.thread_state.registers.rdx, SYSCALL_ARGS.2);
333
334 current_task.thread_state.registers.rax = __NR_rt_sigreturn as u64;
337 current_task.thread_state.registers.rsp += 8; restore_from_signal_handler(current_task).expect("failed to restore state");
340
341 assert_eq!(current_task.thread_state.registers.rax, SYSCALL_NUMBER);
345 assert_eq!(current_task.thread_state.registers.rdi, SYSCALL_ARGS.0);
346 assert_eq!(current_task.thread_state.registers.rsi, SYSCALL_ARGS.1);
347 assert_eq!(current_task.thread_state.registers.rdx, SYSCALL_ARGS.2);
348 assert_eq!(current_task.thread_state.registers.r10, SYSCALL_ARGS.3);
349 assert_eq!(current_task.thread_state.registers.r8, SYSCALL_ARGS.4);
350 assert_eq!(current_task.thread_state.registers.r9, SYSCALL_ARGS.5);
351 assert_eq!(
352 current_task.thread_state.registers.ip,
353 SYSCALL_INSTRUCTION_ADDRESS.ptr() as u64
354 );
355 })
356 .await;
357 }
358
359 #[fuchsia::test]
360 async fn syscall_nested_restart() {
361 spawn_kernel_and_run_with_stack(|current_task| {
362 current_task.thread_group().signal_actions.set(
364 SIGUSR1,
365 sigaction_t {
366 sa_flags: (SA_RESTORER | SA_RESTART | SA_SIGINFO) as u64,
367 sa_handler: SA_HANDLER_ADDRESS.into(),
368 sa_restorer: SA_RESTORER_ADDRESS.into(),
369 ..sigaction_t::default()
370 },
371 );
372 current_task.thread_group().signal_actions.set(
373 SIGUSR2,
374 sigaction_t {
375 sa_flags: (SA_RESTORER | SA_RESTART | SA_SIGINFO) as u64,
376 sa_handler: SA_HANDLER2_ADDRESS.into(),
377 sa_restorer: SA_RESTORER_ADDRESS.into(),
378 ..sigaction_t::default()
379 },
380 );
381
382 current_task.thread_state.restart_code = Some(ERESTARTSYS);
388 current_task.thread_state.registers.rax = ERESTARTSYS.return_value();
389 current_task.thread_state.registers.rdi = SYSCALL_ARGS.0;
390 current_task.thread_state.registers.rsi = SYSCALL_ARGS.1;
391 current_task.thread_state.registers.rdx = SYSCALL_ARGS.2;
392 current_task.thread_state.registers.r10 = SYSCALL_ARGS.3;
393 current_task.thread_state.registers.r8 = SYSCALL_ARGS.4;
394 current_task.thread_state.registers.r9 = SYSCALL_ARGS.5;
395 current_task.thread_state.registers.orig_rax = SYSCALL_NUMBER;
396 current_task.thread_state.registers.ip =
397 (SYSCALL_INSTRUCTION_ADDRESS + 2u64).unwrap().ptr() as u64;
398
399 current_task.write().enqueue_signal(SignalInfo::with_detail(
401 SIGUSR1,
402 SI_USER as i32,
403 SignalDetail::None,
404 ));
405
406 dequeue_signal(current_task);
408
409 assert_eq!(current_task.thread_state.registers.ip, SA_HANDLER_ADDRESS.ptr() as u64);
411
412 assert_ne!(current_task.thread_state.registers.rdi, SYSCALL_ARGS.0);
414 assert_ne!(current_task.thread_state.registers.rsi, SYSCALL_ARGS.1);
415 assert_ne!(current_task.thread_state.registers.rdx, SYSCALL_ARGS.2);
416
417 current_task.thread_state.restart_code = Some(ERESTARTSYS);
419 current_task.thread_state.registers.rax = ERESTARTSYS.return_value();
420 current_task.thread_state.registers.rdi = SYSCALL2_ARGS.0;
421 current_task.thread_state.registers.rsi = SYSCALL2_ARGS.1;
422 current_task.thread_state.registers.rdx = SYSCALL2_ARGS.2;
423 current_task.thread_state.registers.r10 = SYSCALL2_ARGS.3;
424 current_task.thread_state.registers.r8 = SYSCALL2_ARGS.4;
425 current_task.thread_state.registers.r9 = SYSCALL2_ARGS.5;
426 current_task.thread_state.registers.orig_rax = SYSCALL2_NUMBER;
427 current_task.thread_state.registers.ip =
428 (SYSCALL2_INSTRUCTION_ADDRESS + 2u64).unwrap().ptr() as u64;
429
430 current_task.write().enqueue_signal(SignalInfo::with_detail(
432 SIGUSR2,
433 SI_USER as i32,
434 SignalDetail::None,
435 ));
436
437 dequeue_signal(current_task);
439
440 assert_eq!(current_task.thread_state.registers.ip, SA_HANDLER2_ADDRESS.ptr() as u64);
442
443 assert_ne!(current_task.thread_state.registers.rdi, SYSCALL2_ARGS.0);
445 assert_ne!(current_task.thread_state.registers.rsi, SYSCALL2_ARGS.1);
446 assert_ne!(current_task.thread_state.registers.rdx, SYSCALL2_ARGS.2);
447
448 current_task.thread_state.registers.rax = __NR_rt_sigreturn as u64;
451 current_task.thread_state.registers.rsp += 8; restore_from_signal_handler(current_task).expect("failed to restore state");
454
455 assert_eq!(current_task.thread_state.registers.rax, SYSCALL2_NUMBER);
459 assert_eq!(current_task.thread_state.registers.rdi, SYSCALL2_ARGS.0);
460 assert_eq!(current_task.thread_state.registers.rsi, SYSCALL2_ARGS.1);
461 assert_eq!(current_task.thread_state.registers.rdx, SYSCALL2_ARGS.2);
462 assert_eq!(current_task.thread_state.registers.r10, SYSCALL2_ARGS.3);
463 assert_eq!(current_task.thread_state.registers.r8, SYSCALL2_ARGS.4);
464 assert_eq!(current_task.thread_state.registers.r9, SYSCALL2_ARGS.5);
465 assert_eq!(
466 current_task.thread_state.registers.ip,
467 SYSCALL2_INSTRUCTION_ADDRESS.ptr() as u64
468 );
469
470 current_task.thread_state.registers.rax = __NR_rt_sigreturn as u64;
473 current_task.thread_state.registers.rsp += 8; restore_from_signal_handler(current_task).expect("failed to restore state");
476
477 assert_eq!(current_task.thread_state.registers.rax, SYSCALL_NUMBER);
481 assert_eq!(current_task.thread_state.registers.rdi, SYSCALL_ARGS.0);
482 assert_eq!(current_task.thread_state.registers.rsi, SYSCALL_ARGS.1);
483 assert_eq!(current_task.thread_state.registers.rdx, SYSCALL_ARGS.2);
484 assert_eq!(current_task.thread_state.registers.r10, SYSCALL_ARGS.3);
485 assert_eq!(current_task.thread_state.registers.r8, SYSCALL_ARGS.4);
486 assert_eq!(current_task.thread_state.registers.r9, SYSCALL_ARGS.5);
487 assert_eq!(
488 current_task.thread_state.registers.ip,
489 SYSCALL_INSTRUCTION_ADDRESS.ptr() as u64
490 );
491 })
492 .await;
493 }
494
495 #[fuchsia::test]
496 async fn syscall_does_not_restart_if_signal_action_has_no_sa_restart_flag() {
497 spawn_kernel_and_run_with_stack(|current_task| {
498 current_task.thread_group().signal_actions.set(
500 SIGUSR1,
501 sigaction_t {
502 sa_flags: (SA_RESTORER | SA_SIGINFO) as u64,
503 sa_handler: SA_HANDLER_ADDRESS.into(),
504 sa_restorer: SA_RESTORER_ADDRESS.into(),
505 ..sigaction_t::default()
506 },
507 );
508
509 current_task.thread_state.restart_code = Some(ERESTARTSYS);
515 current_task.thread_state.registers.rax = ERESTARTSYS.return_value();
516 current_task.thread_state.registers.rdi = SYSCALL_ARGS.0;
517 current_task.thread_state.registers.rsi = SYSCALL_ARGS.1;
518 current_task.thread_state.registers.rdx = SYSCALL_ARGS.2;
519 current_task.thread_state.registers.r10 = SYSCALL_ARGS.3;
520 current_task.thread_state.registers.r8 = SYSCALL_ARGS.4;
521 current_task.thread_state.registers.r9 = SYSCALL_ARGS.5;
522 current_task.thread_state.registers.orig_rax = SYSCALL_NUMBER;
523 current_task.thread_state.registers.ip =
524 (SYSCALL_INSTRUCTION_ADDRESS + 2u64).unwrap().ptr() as u64;
525
526 current_task.write().enqueue_signal(SignalInfo::with_detail(
528 SIGUSR1,
529 SI_USER as i32,
530 SignalDetail::None,
531 ));
532
533 dequeue_signal(current_task);
535
536 assert_eq!(current_task.thread_state.registers.ip, SA_HANDLER_ADDRESS.ptr() as u64);
538
539 assert_ne!(current_task.thread_state.registers.rdi, SYSCALL_ARGS.0);
541 assert_ne!(current_task.thread_state.registers.rsi, SYSCALL_ARGS.1);
542 assert_ne!(current_task.thread_state.registers.rdx, SYSCALL_ARGS.2);
543
544 current_task.thread_state.registers.rax = __NR_rt_sigreturn as u64;
547 current_task.thread_state.registers.rsp += 8; restore_from_signal_handler(current_task).expect("failed to restore state");
550
551 assert_eq!(current_task.thread_state.registers.rax, EINTR.return_value());
555 assert_eq!(
556 current_task.thread_state.registers.ip,
557 (SYSCALL_INSTRUCTION_ADDRESS + 2u64).unwrap().ptr() as u64
558 );
559 })
560 .await;
561 }
562
563 fn spawn_kernel_and_run_with_stack<F>(callback: F) -> impl Future<Output = ()>
565 where
566 F: FnOnce(&mut CurrentTask) + Send + Sync + 'static,
567 {
568 spawn_kernel_and_run(async |current_task| {
569 const STACK_SIZE: usize = 0x1000;
570
571 let prot_flags = ProtectionFlags::READ | ProtectionFlags::WRITE;
573 let stack_base = current_task
574 .mm()
575 .unwrap()
576 .map_memory(
577 DesiredAddress::Any,
578 MemoryObject::from(
579 zx::Vmo::create(STACK_SIZE as u64).expect("failed to create stack VMO"),
580 )
581 .into(),
582 0,
583 STACK_SIZE,
584 prot_flags,
585 MappingOptions::empty(),
586 MappingName::Stack,
587 )
588 .expect("failed to map stack VMO");
589 let stack_address = (stack_base + (STACK_SIZE - 8)).expect("OOB memory access.");
590 current_task.thread_state.registers.rsp = stack_address.ptr() as u64;
591
592 callback(current_task);
593 })
594 }
595}