1160581Sobrien/* 2160581Sobrien * Copyright (c) 2004 Marcel Moolenaar 3160581Sobrien * All rights reserved. 4160581Sobrien * 5160581Sobrien * Redistribution and use in source and binary forms, with or without 6160581Sobrien * modification, are permitted provided that the following conditions 7160581Sobrien * are met: 8160581Sobrien * 9160581Sobrien * 1. Redistributions of source code must retain the above copyright 10160581Sobrien * notice, this list of conditions and the following disclaimer. 11160581Sobrien * 2. Redistributions in binary form must reproduce the above copyright 12160581Sobrien * notice, this list of conditions and the following disclaimer in the 13160581Sobrien * documentation and/or other materials provided with the distribution. 14160581Sobrien * 15160581Sobrien * THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``AS IS'' AND ANY EXPRESS OR 16160581Sobrien * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 17160581Sobrien * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 18160581Sobrien * IN NO EVENT SHALL THE AUTHORS BE LIABLE FOR ANY DIRECT, INDIRECT, 19160581Sobrien * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 20160581Sobrien * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 21160581Sobrien * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 22160581Sobrien * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 23160581Sobrien * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 24160581Sobrien * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 25160581Sobrien */ 26160581Sobrien 27160581Sobrien#include <sys/cdefs.h> 28160581Sobrien__FBSDID("$FreeBSD$"); 29160581Sobrien 30160581Sobrien#include <sys/types.h> 31162303Simp#ifndef CROSS_DEBUGGER 32160581Sobrien#include <machine/pcb.h> 33160581Sobrien#include <machine/frame.h> 34162303Simp#include <machine/armreg.h> 35162303Simp#endif 36160581Sobrien#include <err.h> 37160581Sobrien#include <kvm.h> 38160581Sobrien#include <string.h> 39160581Sobrien 40160581Sobrien#include <defs.h> 41160581Sobrien#include <target.h> 42160581Sobrien#include <gdbthread.h> 43160581Sobrien#include <inferior.h> 44160581Sobrien#include <regcache.h> 45160581Sobrien#include <frame-unwind.h> 46160581Sobrien#include <arm-tdep.h> 47160581Sobrien 48160581Sobrien#include "kgdb.h" 49160581Sobrien 50246893SmarcelCORE_ADDR 51246893Smarcelkgdb_trgt_core_pcb(u_int cpuid) 52246893Smarcel{ 53246893Smarcel return (kgdb_trgt_stop_pcb(cpuid, sizeof(struct pcb))); 54246893Smarcel} 55246893Smarcel 56160581Sobrienvoid 57160581Sobrienkgdb_trgt_fetch_registers(int regno __unused) 58160581Sobrien{ 59162303Simp#ifndef CROSS_DEBUGGER 60160581Sobrien struct kthr *kt; 61160581Sobrien struct pcb pcb; 62160581Sobrien int i, reg; 63163440Sjhb 64178713Sjhb kt = kgdb_thr_lookup_tid(ptid_get_pid(inferior_ptid)); 65160581Sobrien if (kt == NULL) 66160581Sobrien return; 67160581Sobrien if (kvm_read(kvm, kt->pcb, &pcb, sizeof(pcb)) != sizeof(pcb)) { 68160581Sobrien warnx("kvm_read: %s", kvm_geterr(kvm)); 69160581Sobrien memset(&pcb, 0, sizeof(pcb)); 70160581Sobrien } 71278614Sian for (i = ARM_A1_REGNUM + 4; i <= ARM_SP_REGNUM; i++) { 72278614Sian supply_register(i, (char *)&pcb.pcb_regs.sf_r4 + 73278614Sian (i - (ARM_A1_REGNUM + 4 )) * 4); 74160581Sobrien } 75278614Sian if (pcb.pcb_regs.sf_sp != 0) { 76278614Sian if (kvm_read(kvm, pcb.pcb_regs.sf_sp + 4 * 4, ®, 4) != 4) 77160581Sobrien warnx("kvm_read :%s", kvm_geterr(kvm)); 78160581Sobrien else 79160581Sobrien supply_register(ARM_PC_REGNUM, (char *)®); 80160581Sobrien } 81162303Simp#endif 82160581Sobrien} 83160581Sobrien 84160581Sobrienvoid 85160581Sobrienkgdb_trgt_store_registers(int regno __unused) 86160581Sobrien{ 87160581Sobrien fprintf_unfiltered(gdb_stderr, "XXX: %s\n", __func__); 88160581Sobrien} 89160581Sobrien 90178670Sjhbvoid 91178670Sjhbkgdb_trgt_new_objfile(struct objfile *objfile) 92178670Sjhb{ 93178670Sjhb} 94178670Sjhb 95162303Simp#ifndef CROSS_DEBUGGER 96160581Sobrienstruct kgdb_frame_cache { 97160581Sobrien CORE_ADDR fp; 98160581Sobrien CORE_ADDR sp; 99160581Sobrien}; 100160581Sobrien 101160581Sobrienstatic int kgdb_trgt_frame_offset[26] = { 102160581Sobrien offsetof(struct trapframe, tf_r0), 103160581Sobrien offsetof(struct trapframe, tf_r1), 104160581Sobrien offsetof(struct trapframe, tf_r2), 105160581Sobrien offsetof(struct trapframe, tf_r3), 106160581Sobrien offsetof(struct trapframe, tf_r4), 107160581Sobrien offsetof(struct trapframe, tf_r5), 108160581Sobrien offsetof(struct trapframe, tf_r6), 109160581Sobrien offsetof(struct trapframe, tf_r7), 110160581Sobrien offsetof(struct trapframe, tf_r8), 111160581Sobrien offsetof(struct trapframe, tf_r9), 112160581Sobrien offsetof(struct trapframe, tf_r10), 113160581Sobrien offsetof(struct trapframe, tf_r11), 114160581Sobrien offsetof(struct trapframe, tf_r12), 115160581Sobrien offsetof(struct trapframe, tf_svc_sp), 116160581Sobrien offsetof(struct trapframe, tf_svc_lr), 117160581Sobrien offsetof(struct trapframe, tf_pc), 118160581Sobrien -1, -1, -1, -1, -1, -1, -1, -1, -1, 119160581Sobrien offsetof(struct trapframe, tf_spsr) 120160581Sobrien}; 121160581Sobrien 122160581Sobrienstatic struct kgdb_frame_cache * 123160581Sobrienkgdb_trgt_frame_cache(struct frame_info *next_frame, void **this_cache) 124160581Sobrien{ 125160581Sobrien char buf[MAX_REGISTER_SIZE]; 126160581Sobrien struct kgdb_frame_cache *cache; 127160581Sobrien 128160581Sobrien cache = *this_cache; 129160581Sobrien if (cache == NULL) { 130160581Sobrien cache = FRAME_OBSTACK_ZALLOC(struct kgdb_frame_cache); 131160581Sobrien *this_cache = cache; 132160581Sobrien frame_unwind_register(next_frame, ARM_SP_REGNUM, buf); 133160581Sobrien cache->sp = extract_unsigned_integer(buf, 134160581Sobrien register_size(current_gdbarch, ARM_SP_REGNUM)); 135160581Sobrien frame_unwind_register(next_frame, ARM_FP_REGNUM, buf); 136160581Sobrien cache->fp = extract_unsigned_integer(buf, 137160581Sobrien register_size(current_gdbarch, ARM_FP_REGNUM)); 138160581Sobrien } 139160581Sobrien return (cache); 140160581Sobrien} 141160581Sobrien 142162303Simpstatic int is_undef; 143162303Simp 144160581Sobrienstatic void 145160581Sobrienkgdb_trgt_trapframe_this_id(struct frame_info *next_frame, void **this_cache, 146160581Sobrien struct frame_id *this_id) 147160581Sobrien{ 148160581Sobrien struct kgdb_frame_cache *cache; 149160581Sobrien 150160581Sobrien cache = kgdb_trgt_frame_cache(next_frame, this_cache); 151160581Sobrien *this_id = frame_id_build(cache->fp, 0); 152160581Sobrien} 153160581Sobrien 154160581Sobrienstatic void 155160581Sobrienkgdb_trgt_trapframe_prev_register(struct frame_info *next_frame, 156160581Sobrien void **this_cache, int regnum, int *optimizedp, enum lval_type *lvalp, 157160581Sobrien CORE_ADDR *addrp, int *realnump, void *valuep) 158160581Sobrien{ 159160581Sobrien char dummy_valuep[MAX_REGISTER_SIZE]; 160160581Sobrien struct kgdb_frame_cache *cache; 161160581Sobrien int ofs, regsz; 162162303Simp int is_undefined = 0; 163160581Sobrien 164160581Sobrien regsz = register_size(current_gdbarch, regnum); 165160581Sobrien 166160581Sobrien if (valuep == NULL) 167160581Sobrien valuep = dummy_valuep; 168160581Sobrien memset(valuep, 0, regsz); 169160581Sobrien *optimizedp = 0; 170160581Sobrien *addrp = 0; 171160581Sobrien *lvalp = not_lval; 172160581Sobrien *realnump = -1; 173160581Sobrien 174160581Sobrien ofs = (regnum >= 0 && regnum <= ARM_PS_REGNUM) 175160581Sobrien ? kgdb_trgt_frame_offset[regnum] : -1; 176160581Sobrien if (ofs == -1) 177160581Sobrien return; 178160581Sobrien 179160581Sobrien cache = kgdb_trgt_frame_cache(next_frame, this_cache); 180163440Sjhb 181162303Simp if (is_undef && (regnum == ARM_SP_REGNUM || regnum == ARM_PC_REGNUM)) { 182162303Simp *addrp = cache->sp + offsetof(struct trapframe, tf_spsr); 183162303Simp target_read_memory(*addrp, valuep, regsz); 184162303Simp is_undefined = 1; 185162303Simp ofs = kgdb_trgt_frame_offset[ARM_SP_REGNUM]; 186162303Simp 187162303Simp } 188160581Sobrien *addrp = cache->sp + ofs; 189160581Sobrien *lvalp = lval_memory; 190160581Sobrien target_read_memory(*addrp, valuep, regsz); 191162303Simp 192162303Simp if (is_undefined) { 193162303Simp *addrp = *(unsigned int *)valuep + (regnum == ARM_SP_REGNUM ? 194162303Simp 0 : 8); 195162303Simp target_read_memory(*addrp, valuep, regsz); 196162303Simp 197162303Simp } 198160581Sobrien} 199160581Sobrien 200160581Sobrienstatic const struct frame_unwind kgdb_trgt_trapframe_unwind = { 201160581Sobrien UNKNOWN_FRAME, 202160581Sobrien &kgdb_trgt_trapframe_this_id, 203160581Sobrien &kgdb_trgt_trapframe_prev_register 204160581Sobrien}; 205162303Simp#endif 206160581Sobrien 207160581Sobrienconst struct frame_unwind * 208160581Sobrienkgdb_trgt_trapframe_sniffer(struct frame_info *next_frame) 209160581Sobrien{ 210162303Simp#ifndef CROSS_DEBUGGER 211160581Sobrien char *pname; 212160581Sobrien CORE_ADDR pc; 213160581Sobrien 214160581Sobrien pc = frame_pc_unwind(next_frame); 215160581Sobrien pname = NULL; 216160581Sobrien find_pc_partial_function(pc, &pname, NULL, NULL); 217162303Simp if (pname == NULL) { 218162303Simp is_undef = 0; 219160581Sobrien return (NULL); 220162303Simp } 221162303Simp if (!strcmp(pname, "undefinedinstruction")) 222162303Simp is_undef = 1; 223160581Sobrien if (strcmp(pname, "Laddress_exception_entry") == 0 || 224160581Sobrien strcmp(pname, "undefined_entry") == 0 || 225160581Sobrien strcmp(pname, "exception_exit") == 0 || 226162303Simp strcmp(pname, "Laddress_exception_msg") == 0 || 227160581Sobrien strcmp(pname, "irq_entry") == 0) 228160581Sobrien return (&kgdb_trgt_trapframe_unwind); 229162303Simp if (!strcmp(pname, "undefinedinstruction")) 230162303Simp is_undef = 1; 231162303Simp else 232162303Simp is_undef = 0; 233162303Simp#endif 234160581Sobrien return (NULL); 235160581Sobrien} 236