1 /*- 2 * Copyright (c) 2015 The FreeBSD Foundation 3 * 4 * This software was developed by Andrew Turner under 5 * sponsorship from the FreeBSD Foundation. 6 * 7 * Redistribution and use in source and binary forms, with or without 8 * modification, are permitted provided that the following conditions 9 * are met: 10 * 1. Redistributions of source code must retain the above copyright 11 * notice, this list of conditions and the following disclaimer. 12 * 2. Redistributions in binary form must reproduce the above copyright 13 * notice, this list of conditions and the following disclaimer in the 14 * documentation and/or other materials provided with the distribution. 15 * 16 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 17 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 18 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 19 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 20 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 21 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 22 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 23 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 24 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 25 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 26 * SUCH DAMAGE. 27 * 28 */ 29 30 #include <sys/param.h> 31 #include <sys/systm.h> 32 #include <sys/lock.h> 33 #include <sys/mutex.h> 34 #include <sys/proc.h> 35 #include <sys/stack.h> 36 37 #include <machine/vmparam.h> 38 #include <machine/pcb.h> 39 #include <machine/stack.h> 40 41 static void 42 stack_capture(struct thread *td, struct stack *st, struct unwind_state *frame) 43 { 44 45 stack_zero(st); 46 while (1) { 47 if (!unwind_frame(td, frame)) 48 break; 49 if (!INKERNEL((vm_offset_t)frame->pc)) 50 break; 51 if (stack_put(st, frame->pc) == -1) 52 break; 53 } 54 } 55 56 int 57 stack_save_td(struct stack *st, struct thread *td) 58 { 59 struct unwind_state frame; 60 61 THREAD_LOCK_ASSERT(td, MA_OWNED); 62 KASSERT(!TD_IS_SWAPPED(td), 63 ("stack_save_td: thread %p is swapped", td)); 64 65 if (TD_IS_RUNNING(td)) 66 return (EOPNOTSUPP); 67 68 frame.fp = td->td_pcb->pcb_x[PCB_FP]; 69 frame.pc = ADDR_MAKE_CANONICAL(td->td_pcb->pcb_x[PCB_LR]); 70 71 stack_capture(td, st, &frame); 72 return (0); 73 } 74 75 void 76 stack_save(struct stack *st) 77 { 78 struct unwind_state frame; 79 80 frame.fp = (uintptr_t)__builtin_frame_address(0); 81 frame.pc = (uintptr_t)stack_save; 82 83 stack_capture(curthread, st, &frame); 84 } 85