[2c34be8] | 1 | /*
|
---|
| 2 | * Copyright (c) 2009 Jakub Jermar
|
---|
[e515b21a] | 3 | * Copyright (c) 2010 Jiri Svoboda
|
---|
[2c34be8] | 4 | * All rights reserved.
|
---|
| 5 | *
|
---|
| 6 | * Redistribution and use in source and binary forms, with or without
|
---|
| 7 | * modification, are permitted provided that the following conditions
|
---|
| 8 | * are met:
|
---|
| 9 | *
|
---|
| 10 | * - Redistributions of source code must retain the above copyright
|
---|
| 11 | * notice, this list of conditions and the following disclaimer.
|
---|
| 12 | * - 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 | * - The name of the author may not be used to endorse or promote products
|
---|
| 16 | * derived from this software without specific prior written permission.
|
---|
| 17 | *
|
---|
| 18 | * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
|
---|
| 19 | * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
---|
| 20 | * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
---|
| 21 | * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
---|
| 22 | * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
---|
| 23 | * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
---|
| 24 | * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
---|
| 25 | * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
---|
| 26 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
---|
| 27 | * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
---|
| 28 | */
|
---|
| 29 |
|
---|
| 30 | /** @addtogroup libc
|
---|
| 31 | * @{
|
---|
| 32 | */
|
---|
| 33 | /** @file
|
---|
| 34 | */
|
---|
| 35 |
|
---|
| 36 | #include <stacktrace.h>
|
---|
| 37 | #include <stdio.h>
|
---|
[582a0b8] | 38 | #include <stddef.h>
|
---|
[8d2dd7f2] | 39 | #include <stdint.h>
|
---|
[e515b21a] | 40 | #include <errno.h>
|
---|
[8751cf3] | 41 | #include <io/kio.h>
|
---|
[2c34be8] | 42 |
|
---|
[6bb136b2] | 43 | #define STACK_FRAMES_MAX 20
|
---|
| 44 |
|
---|
[b7fd2a0] | 45 | static errno_t stacktrace_read_uintptr(void *arg, uintptr_t addr, uintptr_t *data);
|
---|
[e515b21a] | 46 |
|
---|
[c1b979a] | 47 | static stacktrace_ops_t basic_ops = {
|
---|
[8751cf3] | 48 | .read_uintptr = stacktrace_read_uintptr,
|
---|
| 49 | .printf = printf,
|
---|
| 50 | };
|
---|
| 51 |
|
---|
| 52 | static stacktrace_ops_t kio_ops = {
|
---|
| 53 | .read_uintptr = stacktrace_read_uintptr,
|
---|
| 54 | .printf = kio_printf,
|
---|
[c1b979a] | 55 | };
|
---|
| 56 |
|
---|
| 57 | void stacktrace_print_generic(stacktrace_ops_t *ops, void *arg, uintptr_t fp,
|
---|
| 58 | uintptr_t pc)
|
---|
[2c34be8] | 59 | {
|
---|
[6bb136b2] | 60 | int cnt = 0;
|
---|
[e515b21a] | 61 | stacktrace_t st;
|
---|
| 62 | uintptr_t nfp;
|
---|
[b7fd2a0] | 63 | errno_t rc;
|
---|
[e515b21a] | 64 |
|
---|
[c1b979a] | 65 | st.op_arg = arg;
|
---|
| 66 | st.ops = ops;
|
---|
[e515b21a] | 67 |
|
---|
[6bb136b2] | 68 | while (cnt++ < STACK_FRAMES_MAX && stacktrace_fp_valid(&st, fp)) {
|
---|
[8751cf3] | 69 | ops->printf("%p: %p()\n", (void *) fp, (void *) pc);
|
---|
[c1b979a] | 70 | rc = stacktrace_ra_get(&st, fp, &pc);
|
---|
| 71 | if (rc != EOK)
|
---|
| 72 | break;
|
---|
| 73 | rc = stacktrace_fp_prev(&st, fp, &nfp);
|
---|
| 74 | if (rc != EOK)
|
---|
| 75 | break;
|
---|
[e515b21a] | 76 | fp = nfp;
|
---|
[2c34be8] | 77 | }
|
---|
| 78 | }
|
---|
| 79 |
|
---|
[c1b979a] | 80 | void stacktrace_print_fp_pc(uintptr_t fp, uintptr_t pc)
|
---|
| 81 | {
|
---|
| 82 | stacktrace_print_generic(&basic_ops, NULL, fp, pc);
|
---|
| 83 | }
|
---|
| 84 |
|
---|
[8751cf3] | 85 | void stacktrace_kio_print(void)
|
---|
| 86 | {
|
---|
| 87 | stacktrace_prepare();
|
---|
| 88 | stacktrace_print_generic(&kio_ops, NULL, stacktrace_fp_get(), stacktrace_pc_get());
|
---|
| 89 |
|
---|
| 90 | /*
|
---|
| 91 | * Prevent the tail call optimization of the previous call by
|
---|
| 92 | * making it a non-tail call.
|
---|
| 93 | */
|
---|
| 94 |
|
---|
| 95 | kio_printf("-- end of stack trace --\n");
|
---|
| 96 | }
|
---|
| 97 |
|
---|
[e515b21a] | 98 | void stacktrace_print(void)
|
---|
[2c34be8] | 99 | {
|
---|
[e515b21a] | 100 | stacktrace_prepare();
|
---|
| 101 | stacktrace_print_fp_pc(stacktrace_fp_get(), stacktrace_pc_get());
|
---|
[a35b458] | 102 |
|
---|
[5434000] | 103 | /*
|
---|
| 104 | * Prevent the tail call optimization of the previous call by
|
---|
| 105 | * making it a non-tail call.
|
---|
| 106 | */
|
---|
[a35b458] | 107 |
|
---|
[c7bbf029] | 108 | printf("-- end of stack trace --\n");
|
---|
[e515b21a] | 109 | }
|
---|
| 110 |
|
---|
[b7fd2a0] | 111 | static errno_t stacktrace_read_uintptr(void *arg, uintptr_t addr, uintptr_t *data)
|
---|
[e515b21a] | 112 | {
|
---|
| 113 | (void) arg;
|
---|
| 114 | *data = *((uintptr_t *) addr);
|
---|
| 115 | return EOK;
|
---|
[2c34be8] | 116 | }
|
---|
| 117 |
|
---|
| 118 | /** @}
|
---|
| 119 | */
|
---|