Jason Wessel | 5d5314d | 2010-05-20 21:04:20 -0500 | [diff] [blame] | 1 | /* |
| 2 | * Created by: Jason Wessel <jason.wessel@windriver.com> |
| 3 | * |
| 4 | * Copyright (c) 2009 Wind River Systems, Inc. All Rights Reserved. |
| 5 | * |
| 6 | * This file is licensed under the terms of the GNU General Public |
| 7 | * License version 2. This program is licensed "as is" without any |
| 8 | * warranty of any kind, whether express or implied. |
| 9 | */ |
| 10 | |
| 11 | #include <linux/kgdb.h> |
| 12 | #include <linux/kdb.h> |
| 13 | #include <linux/kdebug.h> |
| 14 | #include "kdb_private.h" |
| 15 | #include "../debug_core.h" |
| 16 | |
| 17 | /* |
| 18 | * KDB interface to KGDB internals |
| 19 | */ |
| 20 | get_char_func kdb_poll_funcs[] = { |
| 21 | dbg_io_get_char, |
| 22 | NULL, |
Jason Wessel | f5316b4 | 2010-05-20 21:04:22 -0500 | [diff] [blame] | 23 | NULL, |
| 24 | NULL, |
| 25 | NULL, |
| 26 | NULL, |
Jason Wessel | 5d5314d | 2010-05-20 21:04:20 -0500 | [diff] [blame] | 27 | }; |
Jason Wessel | f5316b4 | 2010-05-20 21:04:22 -0500 | [diff] [blame] | 28 | EXPORT_SYMBOL_GPL(kdb_poll_funcs); |
| 29 | |
| 30 | int kdb_poll_idx = 1; |
| 31 | EXPORT_SYMBOL_GPL(kdb_poll_idx); |
Jason Wessel | 5d5314d | 2010-05-20 21:04:20 -0500 | [diff] [blame] | 32 | |
| 33 | int kdb_stub(struct kgdb_state *ks) |
| 34 | { |
| 35 | int error = 0; |
| 36 | kdb_bp_t *bp; |
| 37 | unsigned long addr = kgdb_arch_pc(ks->ex_vector, ks->linux_regs); |
| 38 | kdb_reason_t reason = KDB_REASON_OOPS; |
| 39 | kdb_dbtrap_t db_result = KDB_DB_NOBPT; |
| 40 | int i; |
| 41 | |
| 42 | if (KDB_STATE(REENTRY)) { |
| 43 | reason = KDB_REASON_SWITCH; |
| 44 | KDB_STATE_CLEAR(REENTRY); |
| 45 | addr = instruction_pointer(ks->linux_regs); |
| 46 | } |
| 47 | ks->pass_exception = 0; |
| 48 | if (atomic_read(&kgdb_setting_breakpoint)) |
| 49 | reason = KDB_REASON_KEYBOARD; |
| 50 | |
| 51 | for (i = 0, bp = kdb_breakpoints; i < KDB_MAXBPT; i++, bp++) { |
| 52 | if ((bp->bp_enabled) && (bp->bp_addr == addr)) { |
| 53 | reason = KDB_REASON_BREAK; |
| 54 | db_result = KDB_DB_BPT; |
| 55 | if (addr != instruction_pointer(ks->linux_regs)) |
| 56 | kgdb_arch_set_pc(ks->linux_regs, addr); |
| 57 | break; |
| 58 | } |
| 59 | } |
| 60 | if (reason == KDB_REASON_BREAK || reason == KDB_REASON_SWITCH) { |
| 61 | for (i = 0, bp = kdb_breakpoints; i < KDB_MAXBPT; i++, bp++) { |
| 62 | if (bp->bp_free) |
| 63 | continue; |
| 64 | if (bp->bp_addr == addr) { |
| 65 | bp->bp_delay = 1; |
| 66 | bp->bp_delayed = 1; |
| 67 | /* |
| 68 | * SSBPT is set when the kernel debugger must single step a |
| 69 | * task in order to re-establish an instruction breakpoint |
| 70 | * which uses the instruction replacement mechanism. It is |
| 71 | * cleared by any action that removes the need to single-step |
| 72 | * the breakpoint. |
| 73 | */ |
| 74 | reason = KDB_REASON_BREAK; |
| 75 | db_result = KDB_DB_BPT; |
| 76 | KDB_STATE_SET(SSBPT); |
| 77 | break; |
| 78 | } |
| 79 | } |
| 80 | } |
| 81 | |
| 82 | if (reason != KDB_REASON_BREAK && ks->ex_vector == 0 && |
| 83 | ks->signo == SIGTRAP) { |
| 84 | reason = KDB_REASON_SSTEP; |
| 85 | db_result = KDB_DB_BPT; |
| 86 | } |
| 87 | /* Set initial kdb state variables */ |
| 88 | KDB_STATE_CLEAR(KGDB_TRANS); |
Jason Wessel | 495363d | 2010-05-21 08:46:00 -0500 | [diff] [blame] | 89 | kdb_initial_cpu = atomic_read(&kgdb_active); |
Jason Wessel | 5d5314d | 2010-05-20 21:04:20 -0500 | [diff] [blame] | 90 | kdb_current_task = kgdb_info[ks->cpu].task; |
| 91 | kdb_current_regs = kgdb_info[ks->cpu].debuggerinfo; |
| 92 | /* Remove any breakpoints as needed by kdb and clear single step */ |
| 93 | kdb_bp_remove(); |
| 94 | KDB_STATE_CLEAR(DOING_SS); |
| 95 | KDB_STATE_CLEAR(DOING_SSB); |
Jason Wessel | f5316b4 | 2010-05-20 21:04:22 -0500 | [diff] [blame] | 96 | KDB_STATE_SET(PAGER); |
Jason Wessel | 5d5314d | 2010-05-20 21:04:20 -0500 | [diff] [blame] | 97 | /* zero out any offline cpu data */ |
| 98 | for_each_present_cpu(i) { |
| 99 | if (!cpu_online(i)) { |
| 100 | kgdb_info[i].debuggerinfo = NULL; |
| 101 | kgdb_info[i].task = NULL; |
| 102 | } |
| 103 | } |
| 104 | if (ks->err_code == DIE_OOPS || reason == KDB_REASON_OOPS) { |
| 105 | ks->pass_exception = 1; |
| 106 | KDB_FLAG_SET(CATASTROPHIC); |
| 107 | } |
Jason Wessel | 5d5314d | 2010-05-20 21:04:20 -0500 | [diff] [blame] | 108 | if (KDB_STATE(SSBPT) && reason == KDB_REASON_SSTEP) { |
| 109 | KDB_STATE_CLEAR(SSBPT); |
| 110 | KDB_STATE_CLEAR(DOING_SS); |
| 111 | } else { |
| 112 | /* Start kdb main loop */ |
| 113 | error = kdb_main_loop(KDB_REASON_ENTER, reason, |
| 114 | ks->err_code, db_result, ks->linux_regs); |
| 115 | } |
| 116 | /* |
| 117 | * Upon exit from the kdb main loop setup break points and restart |
| 118 | * the system based on the requested continue state |
| 119 | */ |
| 120 | kdb_initial_cpu = -1; |
| 121 | kdb_current_task = NULL; |
| 122 | kdb_current_regs = NULL; |
Jason Wessel | f5316b4 | 2010-05-20 21:04:22 -0500 | [diff] [blame] | 123 | KDB_STATE_CLEAR(PAGER); |
Jason Wessel | 5d5314d | 2010-05-20 21:04:20 -0500 | [diff] [blame] | 124 | kdbnearsym_cleanup(); |
| 125 | if (error == KDB_CMD_KGDB) { |
| 126 | if (KDB_STATE(DOING_KGDB) || KDB_STATE(DOING_KGDB2)) { |
| 127 | /* |
| 128 | * This inteface glue which allows kdb to transition in into |
| 129 | * the gdb stub. In order to do this the '?' or '' gdb serial |
| 130 | * packet response is processed here. And then control is |
| 131 | * passed to the gdbstub. |
| 132 | */ |
| 133 | if (KDB_STATE(DOING_KGDB)) |
| 134 | gdbstub_state(ks, "?"); |
| 135 | else |
| 136 | gdbstub_state(ks, ""); |
| 137 | KDB_STATE_CLEAR(DOING_KGDB); |
| 138 | KDB_STATE_CLEAR(DOING_KGDB2); |
| 139 | } |
| 140 | return DBG_PASS_EVENT; |
| 141 | } |
| 142 | kdb_bp_install(ks->linux_regs); |
| 143 | dbg_activate_sw_breakpoints(); |
| 144 | /* Set the exit state to a single step or a continue */ |
| 145 | if (KDB_STATE(DOING_SS)) |
| 146 | gdbstub_state(ks, "s"); |
| 147 | else |
| 148 | gdbstub_state(ks, "c"); |
| 149 | |
| 150 | KDB_FLAG_CLEAR(CATASTROPHIC); |
| 151 | |
| 152 | /* Invoke arch specific exception handling prior to system resume */ |
| 153 | kgdb_info[ks->cpu].ret_state = gdbstub_state(ks, "e"); |
| 154 | if (ks->pass_exception) |
| 155 | kgdb_info[ks->cpu].ret_state = 1; |
| 156 | if (error == KDB_CMD_CPU) { |
| 157 | KDB_STATE_SET(REENTRY); |
| 158 | /* |
| 159 | * Force clear the single step bit because kdb emulates this |
| 160 | * differently vs the gdbstub |
| 161 | */ |
| 162 | kgdb_single_step = 0; |
| 163 | dbg_deactivate_sw_breakpoints(); |
| 164 | return DBG_SWITCH_CPU_EVENT; |
| 165 | } |
| 166 | return kgdb_info[ks->cpu].ret_state; |
| 167 | } |
| 168 | |