[dragonfly.git] / gnu / usr.bin / gdb / kgdb / trgt_i386.c

/*
 * Copyright (c) 2004 Marcel Moolenaar
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``AS IS'' AND ANY EXPRESS OR
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
 * IN NO EVENT SHALL THE AUTHORS BE LIABLE FOR ANY DIRECT, INDIRECT,
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 *
 * $FreeBSD: src/gnu/usr.bin/gdb/kgdb/trgt_i386.c,v 1.13 2008/09/27 15:58:37 kib Exp $
 */

#include <sys/cdefs.h>

#include <sys/types.h>
#include <machine/thread.h>
#include <sys/thread.h>
#include <machine/globaldata.h>
#include <machine/pcb.h>
#include <machine/frame.h>
#include <machine/segments.h>
#include <machine/tss.h>
#include <err.h>
#include <kvm.h>
#include <string.h>

#include <defs.h>
#include <target.h>
#include <gdbthread.h>
#include <inferior.h>
#include <regcache.h>
#include <frame-unwind.h>
#include <i386-tdep.h>

#include "kgdb.h"

static int
kgdb_trgt_trapframe_sniffer(const struct frame_unwind *self,
			    struct frame_info *next_frame,
			    void **this_prologue_cache);

void
kgdb_trgt_fetch_registers(struct target_ops *target_ops, struct regcache *regcache, int regno)
{
	struct kthr *kt;
	struct pcb pcb;

	kt = kgdb_thr_lookup_tid(ptid_get_tid(inferior_ptid));
	if (kt == NULL) {
		regcache_raw_supply(regcache, regno, NULL);
		return;
	}

	/*
	 * kt->pcb == 0 is a marker for "non-dumping kernel thread".
	 */
	if (kt->pcb == 0) {
		uintptr_t regs[5];
		uintptr_t addr;
		uintptr_t sp;

		addr = kt->kaddr + offsetof(struct thread, td_sp);
		kvm_read(kvm, addr, &sp, sizeof(sp));
		/*
		 * Stack is:
		 * -2 ret
		 * -1 popfl
		 * 0 popl %edi
		 * 1 popl %esi
		 * 2 popl %ebx
		 * 3 popl %ebp
		 * 4 ret
		 */
		if (kvm_read(kvm, sp + 2 * sizeof(regs[0]), regs, sizeof(regs)) != sizeof(regs)) {
			warnx("kvm_read: %s", kvm_geterr(kvm));
			memset(regs, 0, sizeof(regs));
		}
		regcache_raw_supply(regcache, I386_EDI_REGNUM, &regs[0]);
		regcache_raw_supply(regcache, I386_ESI_REGNUM, &regs[1]);
		regcache_raw_supply(regcache, I386_EBX_REGNUM, &regs[2]);
		regcache_raw_supply(regcache, I386_EBP_REGNUM, &regs[3]);
		regcache_raw_supply(regcache, I386_EIP_REGNUM, &regs[4]);
		sp += 7 * sizeof(regs[0]);
		regcache_raw_supply(regcache, I386_ESP_REGNUM, &sp);
		return;
	}

	if (kvm_read(kvm, kt->pcb, &pcb, sizeof(pcb)) != sizeof(pcb)) {
		warnx("kvm_read: %s", kvm_geterr(kvm));
		memset(&pcb, 0, sizeof(pcb));
	}
	regcache_raw_supply(regcache, I386_EBX_REGNUM, (char *)&pcb.pcb_ebx);
	regcache_raw_supply(regcache, I386_ESP_REGNUM, (char *)&pcb.pcb_esp);
	regcache_raw_supply(regcache, I386_EBP_REGNUM, (char *)&pcb.pcb_ebp);
	regcache_raw_supply(regcache, I386_ESI_REGNUM, (char *)&pcb.pcb_esi);
	regcache_raw_supply(regcache, I386_EDI_REGNUM, (char *)&pcb.pcb_edi);
	regcache_raw_supply(regcache, I386_EIP_REGNUM, (char *)&pcb.pcb_eip);
}

struct kgdb_tss_cache {
	CORE_ADDR	pc;
	CORE_ADDR	sp;
	CORE_ADDR	tss;
};

static int kgdb_trgt_tss_offset[15] = {
	offsetof(struct i386tss, tss_eax),
	offsetof(struct i386tss, tss_ecx),
	offsetof(struct i386tss, tss_edx),
	offsetof(struct i386tss, tss_ebx),
	offsetof(struct i386tss, tss_esp),
	offsetof(struct i386tss, tss_ebp),
	offsetof(struct i386tss, tss_esi),
	offsetof(struct i386tss, tss_edi),
	offsetof(struct i386tss, tss_eip),
	offsetof(struct i386tss, tss_eflags),
	offsetof(struct i386tss, tss_cs),
	offsetof(struct i386tss, tss_ss),
	offsetof(struct i386tss, tss_ds),
	offsetof(struct i386tss, tss_es),
	offsetof(struct i386tss, tss_fs)
};

/*
 * If the current thread is executing on a CPU, fetch the common_tss
 * for that CPU.
 *
 * This is painful because 'struct pcpu' is variant sized, so we can't
 * use it.  Instead, we lookup the GDT selector for this CPU and
 * extract the base of the TSS from there.
 */
static CORE_ADDR
kgdb_trgt_fetch_tss(void)
{
	struct kthr *kt;
	struct segment_descriptor sd;
	uintptr_t addr, tss;

	kt = kgdb_thr_lookup_tid(ptid_get_tid(inferior_ptid));
	if (kt == NULL || kt->gd == 0)
		return (0);

	addr = kt->gd + offsetof(struct mdglobaldata, gd_common_tssd);
	if (kvm_read(kvm, addr, &sd, sizeof(sd)) != sizeof(sd)) {
		warnx("kvm_read: %s", kvm_geterr(kvm));
		return (0);
	}
	if (sd.sd_type != SDT_SYS386BSY) {
		warnx("descriptor is not a busy TSS");
		return (0);
	}
	tss = kt->gd + offsetof(struct mdglobaldata, gd_common_tss);

	return ((CORE_ADDR)tss);
}

static struct kgdb_tss_cache *
kgdb_trgt_tss_cache(struct frame_info *next_frame, void **this_cache)
{
	struct gdbarch *gdbarch = get_frame_arch(next_frame);
	enum bfd_endian byte_order = gdbarch_byte_order(gdbarch);
	char buf[MAX_REGISTER_SIZE];
	struct kgdb_tss_cache *cache;

	cache = *this_cache;
	if (cache == NULL) {
		cache = FRAME_OBSTACK_ZALLOC(struct kgdb_tss_cache);
		*this_cache = cache;
		cache->pc = get_frame_address_in_block(next_frame);
		frame_unwind_register(next_frame, I386_ESP_REGNUM, buf);
		cache->sp = extract_unsigned_integer(buf,
		    register_size(gdbarch, I386_ESP_REGNUM),
		    byte_order);
		cache->tss = kgdb_trgt_fetch_tss();
	}
	return (cache);
}

static void
kgdb_trgt_dblfault_this_id(struct frame_info *next_frame, void **this_cache,
    struct frame_id *this_id)
{
	struct kgdb_tss_cache *cache;

	cache = kgdb_trgt_tss_cache(next_frame, this_cache);
	*this_id = frame_id_build(cache->sp, cache->pc);
}

static struct value *
kgdb_trgt_dblfault_prev_register(struct frame_info *next_frame,
    void **this_cache, int regnum)
{
	CORE_ADDR addrp;
	struct kgdb_tss_cache *cache;
	int ofs;

	if (regnum < I386_EAX_REGNUM || regnum > I386_FS_REGNUM)
		return frame_unwind_got_register(next_frame, regnum, regnum);

	ofs = kgdb_trgt_tss_offset[regnum];

	cache = kgdb_trgt_tss_cache(next_frame, this_cache);
	if (cache->tss == 0)
		return frame_unwind_got_register(next_frame, regnum, regnum);

	addrp = cache->tss + ofs;
	return frame_unwind_got_memory(next_frame, regnum, addrp);
}

static enum unwind_stop_reason
kgdb_trgt_dblfault_unwind_reason(struct frame_info *next_frame,
    void **this_cache)
{
    /* XXX marino : populate logic to determine unwind stoppage */
    return UNWIND_NO_REASON;
}

static const struct frame_unwind kgdb_trgt_dblfault_unwind = {
        NORMAL_FRAME,
        &kgdb_trgt_dblfault_unwind_reason,
        &kgdb_trgt_dblfault_this_id,
        &kgdb_trgt_dblfault_prev_register,
	.sniffer = kgdb_trgt_trapframe_sniffer
};

struct kgdb_frame_cache {
	int		frame_type;
	CORE_ADDR	pc;
	CORE_ADDR	sp;
};
#define	FT_NORMAL		1
#define	FT_INTRFRAME		2
/*#define	FT_INTRTRAPFRAME	3*/
#define	FT_TIMERFRAME		4
#define	FT_CALLTRAP		5

static int kgdb_trgt_frame_offset[15] = {
	offsetof(struct trapframe, tf_eax),
	offsetof(struct trapframe, tf_ecx),
	offsetof(struct trapframe, tf_edx),
	offsetof(struct trapframe, tf_ebx),
	offsetof(struct trapframe, tf_esp),
	offsetof(struct trapframe, tf_ebp),
	offsetof(struct trapframe, tf_esi),
	offsetof(struct trapframe, tf_edi),
	offsetof(struct trapframe, tf_eip),
	offsetof(struct trapframe, tf_eflags),
	offsetof(struct trapframe, tf_cs),
	offsetof(struct trapframe, tf_ss),
	offsetof(struct trapframe, tf_ds),
	offsetof(struct trapframe, tf_es),
	offsetof(struct trapframe, tf_fs)
};

static struct kgdb_frame_cache *
kgdb_trgt_frame_cache(struct frame_info *next_frame, void **this_cache)
{
	struct kgdb_frame_cache *cache;
	char *pname;

	cache = *this_cache;
	if (cache == NULL) {
		cache = FRAME_OBSTACK_ZALLOC(struct kgdb_frame_cache);
		*this_cache = cache;
		cache->pc = get_frame_address_in_block(next_frame);
		cache->sp = get_frame_sp(next_frame);
		find_pc_partial_function(cache->pc, &pname, NULL, NULL);

		if (strcmp(pname, "calltrap") == 0)
			cache->frame_type = FT_CALLTRAP;
		else if (pname[0] != 'X')
			cache->frame_type = FT_NORMAL;
		else if (strcmp(pname, "Xtimerint") == 0)
			cache->frame_type = FT_TIMERFRAME;
		/* else if (strcmp(pname, "Xcpustop") == 0 ||
		    strcmp(pname, "Xrendezvous") == 0 ||
		    strcmp(pname, "Xipi_intr_bitmap_handler") == 0 ||
		    strcmp(pname, "Xlazypmap") == 0)
			cache->frame_type = FT_INTRTRAPFRAME;
			*/
		else
			cache->frame_type = FT_INTRFRAME;
	}
	return (cache);
}

static void
kgdb_trgt_trapframe_this_id(struct frame_info *next_frame, void **this_cache,
    struct frame_id *this_id)
{
	struct kgdb_frame_cache *cache;

	cache = kgdb_trgt_frame_cache(next_frame, this_cache);
	*this_id = frame_id_build(cache->sp, cache->pc);
}

static struct value *
kgdb_trgt_trapframe_prev_register(struct frame_info *next_frame,
    void **this_cache, int regnum)
{
	CORE_ADDR addrp;
	struct kgdb_frame_cache *cache;
	int ofs;

	if (regnum < I386_EAX_REGNUM || regnum > I386_FS_REGNUM)
		return frame_unwind_got_register(next_frame, regnum, regnum);

	ofs = kgdb_trgt_frame_offset[regnum] + 4;

	cache = kgdb_trgt_frame_cache(next_frame, this_cache);

	switch (cache->frame_type) {
	case FT_NORMAL:
		break;
	case FT_INTRFRAME:
		ofs += 4;
		break;
	case FT_TIMERFRAME:
		break;
		/*
	case FT_INTRTRAPFRAME:
		ofs -= ofs_fix;
		break;
		*/
	case FT_CALLTRAP:
		ofs += 0;
		break;
	default:
		fprintf_unfiltered(gdb_stderr, "Correct FT_XXX frame offsets "
		   "for %d\n", cache->frame_type);
		break;
	}

	addrp = cache->sp + ofs;

#if 0
	/*
	 * If we are in the kernel, we don't have esp stored in the
	 * trapframe, but we can calculate it simply by subtracting
	 * the size of the frame.
	 */
	if (regnum == I386_ESP_REGNUM) {
		char buf[4];

		frame_unwind_register(next_frame, I386_CS_REGNUM, buf);
		if (extract_unsigned_integer(buf, 4, byte_order) != SEL_UPL)
			return frame_unwind_got_address(next_frame, regnum, addrp);
		/* else FALLTHROUGH */
	}
#endif

	return frame_unwind_got_memory(next_frame, regnum, addrp);
}

static enum unwind_stop_reason
kgdb_trgt_trapframe_unwind_reason(struct frame_info *next_frame,
    void **this_cache)
{
    /* XXX marino : populate logic to determine unwind stoppage */
    return UNWIND_NO_REASON;
}

const struct frame_unwind kgdb_trgt_trapframe_unwind = {
        NORMAL_FRAME,
        &kgdb_trgt_trapframe_unwind_reason,
        &kgdb_trgt_trapframe_this_id,
        &kgdb_trgt_trapframe_prev_register,
	.sniffer = kgdb_trgt_trapframe_sniffer
};

static int
kgdb_trgt_trapframe_sniffer(const struct frame_unwind *self,
			    struct frame_info *next_frame,
			    void **this_prologue_cache)
{
	char *pname;
	CORE_ADDR pc;

	pc = get_frame_address_in_block(next_frame);
	pname = NULL;
	find_pc_partial_function(pc, &pname, NULL, NULL);
	if (pname == NULL)
		return (0);

	/*
	 * This is a combined sniffer, since only the
	 * function names change.
	 */

	/*
	 * If we're the sniffer for a trapframe, deal with
	 * all these function names.
	 */
	if (self == &kgdb_trgt_trapframe_unwind &&
	    (strcmp(pname, "calltrap") == 0 ||
	     (pname[0] == 'X' && pname[1] != '_')))
		return (1);

	/*
	 * If we're a double fault sniffer, only look for
	 * the double fault name.
	 */
	if(self == &kgdb_trgt_dblfault_unwind &&
	   strcmp(pname, "dblfault_handler") == 0)
		return (1);

	/* printf("%s: %llx =%s\n", __func__, pc, pname); */
	return (0);
}
Commit	Line	Data
8b6a428f SS	1	/*
	2	* Copyright (c) 2004 Marcel Moolenaar
	3	* All rights reserved.
	4	*
	5	* Redistribution and use in source and binary forms, with or without
	6	* modification, are permitted provided that the following conditions
	7	* are met:
	8	*
	9	* 1. Redistributions of source code must retain the above copyright
	10	* notice, this list of conditions and the following disclaimer.
	11	* 2. Redistributions in binary form must reproduce the above copyright
	12	* notice, this list of conditions and the following disclaimer in the
	13	* documentation and/or other materials provided with the distribution.
	14	*
	15	* THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``AS IS'' AND ANY EXPRESS OR
	16	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
	17	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
	18	* IN NO EVENT SHALL THE AUTHORS BE LIABLE FOR ANY DIRECT, INDIRECT,
	19	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
	20	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
	21	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
	22	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
	23	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
	24	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
	25	*
f17ea84b	26	* $FreeBSD: src/gnu/usr.bin/gdb/kgdb/trgt_i386.c,v 1.13 2008/09/27 15:58:37 kib Exp $
8b6a428f SS	27	*/
	28
	29	#include <sys/cdefs.h>
	30
	31	#include <sys/types.h>
	32	#include <machine/thread.h>
	33	#include <sys/thread.h>
f17ea84b	34	#include <machine/globaldata.h>
8b6a428f SS	35	#include <machine/pcb.h>
8b6a428f SS	36	#include <machine/frame.h>
f17ea84b SS	37	#include <machine/segments.h>
f17ea84b SS	38	#include <machine/tss.h>
8b6a428f SS	39	#include <err.h>
	40	#include <kvm.h>
	41	#include <string.h>
	42
	43	#include <defs.h>
	44	#include <target.h>
	45	#include <gdbthread.h>
	46	#include <inferior.h>
	47	#include <regcache.h>
	48	#include <frame-unwind.h>
	49	#include <i386-tdep.h>
	50
	51	#include "kgdb.h"
	52
f17ea84b SS	53	static int
	54	kgdb_trgt_trapframe_sniffer(const struct frame_unwind *self,
	55	struct frame_info *next_frame,
	56	void **this_prologue_cache);
	57
8b6a428f	58	void
f17ea84b	59	kgdb_trgt_fetch_registers(struct target_ops target_ops, struct regcache regcache, int regno)
8b6a428f SS	60	{
	61	struct kthr *kt;
	62	struct pcb pcb;
	63
	64	kt = kgdb_thr_lookup_tid(ptid_get_tid(inferior_ptid));
0c3d4888 SS	65	if (kt == NULL) {
0c3d4888 SS	66	regcache_raw_supply(regcache, regno, NULL);
8b6a428f	67	return;
0c3d4888	68	}
8b6a428f SS	69
8b6a428f SS	70	/*
3641b7ca	71	* kt->pcb == 0 is a marker for "non-dumping kernel thread".
8b6a428f	72	*/
3641b7ca	73	if (kt->pcb == 0) {
8b6a428f SS	74	uintptr_t regs[5];
	75	uintptr_t addr;
	76	uintptr_t sp;
	77
	78	addr = kt->kaddr + offsetof(struct thread, td_sp);
	79	kvm_read(kvm, addr, &sp, sizeof(sp));
	80	/*
	81	* Stack is:
	82	* -2 ret
	83	* -1 popfl
	84	* 0 popl %edi
	85	* 1 popl %esi
	86	* 2 popl %ebx
	87	* 3 popl %ebp
	88	* 4 ret
	89	*/
	90	if (kvm_read(kvm, sp + 2 * sizeof(regs[0]), regs, sizeof(regs)) != sizeof(regs)) {
	91	warnx("kvm_read: %s", kvm_geterr(kvm));
	92	memset(regs, 0, sizeof(regs));
	93	}
0c3d4888 SS	94	regcache_raw_supply(regcache, I386_EDI_REGNUM, &regs[0]);
	95	regcache_raw_supply(regcache, I386_ESI_REGNUM, &regs[1]);
	96	regcache_raw_supply(regcache, I386_EBX_REGNUM, &regs[2]);
	97	regcache_raw_supply(regcache, I386_EBP_REGNUM, &regs[3]);
	98	regcache_raw_supply(regcache, I386_EIP_REGNUM, &regs[4]);
fb6749dc	99	sp += 7 * sizeof(regs[0]);
0c3d4888	100	regcache_raw_supply(regcache, I386_ESP_REGNUM, &sp);
8b6a428f SS	101	return;
	102	}
	103
	104	if (kvm_read(kvm, kt->pcb, &pcb, sizeof(pcb)) != sizeof(pcb)) {
	105	warnx("kvm_read: %s", kvm_geterr(kvm));
	106	memset(&pcb, 0, sizeof(pcb));
	107	}
0c3d4888 SS	108	regcache_raw_supply(regcache, I386_EBX_REGNUM, (char *)&pcb.pcb_ebx);
	109	regcache_raw_supply(regcache, I386_ESP_REGNUM, (char *)&pcb.pcb_esp);
	110	regcache_raw_supply(regcache, I386_EBP_REGNUM, (char *)&pcb.pcb_ebp);
	111	regcache_raw_supply(regcache, I386_ESI_REGNUM, (char *)&pcb.pcb_esi);
	112	regcache_raw_supply(regcache, I386_EDI_REGNUM, (char *)&pcb.pcb_edi);
	113	regcache_raw_supply(regcache, I386_EIP_REGNUM, (char *)&pcb.pcb_eip);
8b6a428f SS	114	}
8b6a428f SS	115
f17ea84b SS	116	struct kgdb_tss_cache {
	117	CORE_ADDR pc;
	118	CORE_ADDR sp;
	119	CORE_ADDR tss;
	120	};
	121
	122	static int kgdb_trgt_tss_offset[15] = {
	123	offsetof(struct i386tss, tss_eax),
	124	offsetof(struct i386tss, tss_ecx),
	125	offsetof(struct i386tss, tss_edx),
	126	offsetof(struct i386tss, tss_ebx),
	127	offsetof(struct i386tss, tss_esp),
	128	offsetof(struct i386tss, tss_ebp),
	129	offsetof(struct i386tss, tss_esi),
	130	offsetof(struct i386tss, tss_edi),
	131	offsetof(struct i386tss, tss_eip),
	132	offsetof(struct i386tss, tss_eflags),
	133	offsetof(struct i386tss, tss_cs),
	134	offsetof(struct i386tss, tss_ss),
	135	offsetof(struct i386tss, tss_ds),
	136	offsetof(struct i386tss, tss_es),
	137	offsetof(struct i386tss, tss_fs)
	138	};
	139
	140	/*
	141	* If the current thread is executing on a CPU, fetch the common_tss
	142	* for that CPU.
	143	*
	144	* This is painful because 'struct pcpu' is variant sized, so we can't
	145	* use it. Instead, we lookup the GDT selector for this CPU and
	146	* extract the base of the TSS from there.
	147	*/
	148	static CORE_ADDR
	149	kgdb_trgt_fetch_tss(void)
	150	{
	151	struct kthr *kt;
	152	struct segment_descriptor sd;
	153	uintptr_t addr, tss;
	154
	155	kt = kgdb_thr_lookup_tid(ptid_get_tid(inferior_ptid));
	156	if (kt == NULL \|\| kt->gd == 0)
	157	return (0);
	158
	159	addr = kt->gd + offsetof(struct mdglobaldata, gd_common_tssd);
	160	if (kvm_read(kvm, addr, &sd, sizeof(sd)) != sizeof(sd)) {
	161	warnx("kvm_read: %s", kvm_geterr(kvm));
	162	return (0);
	163	}
	164	if (sd.sd_type != SDT_SYS386BSY) {
	165	warnx("descriptor is not a busy TSS");
	166	return (0);
	167	}
	168	tss = kt->gd + offsetof(struct mdglobaldata, gd_common_tss);
	169
	170	return ((CORE_ADDR)tss);
	171	}
	172
	173	static struct kgdb_tss_cache *
	174	kgdb_trgt_tss_cache(struct frame_info next_frame, void *this_cache)
	175	{
	176	struct gdbarch *gdbarch = get_frame_arch(next_frame);
	177	enum bfd_endian byte_order = gdbarch_byte_order(gdbarch);
	178	char buf[MAX_REGISTER_SIZE];
	179	struct kgdb_tss_cache *cache;
180
181	cache = *this_cache;
182	if (cache == NULL) {
183	cache = FRAME_OBSTACK_ZALLOC(struct kgdb_tss_cache);
184	*this_cache = cache;
185	cache->pc = get_frame_address_in_block(next_frame);
186	frame_unwind_register(next_frame, I386_ESP_REGNUM, buf);
187	cache->sp = extract_unsigned_integer(buf,
188	register_size(gdbarch, I386_ESP_REGNUM),
189	byte_order);
190	cache->tss = kgdb_trgt_fetch_tss();
191	}
192	return (cache);
193	}
194
195	static void
196	kgdb_trgt_dblfault_this_id(struct frame_info next_frame, void *this_cache,
197	struct frame_id *this_id)
198	{
199	struct kgdb_tss_cache *cache;
200
201	cache = kgdb_trgt_tss_cache(next_frame, this_cache);
202	*this_id = frame_id_build(cache->sp, cache->pc);
203	}
204
205	static struct value *
206	kgdb_trgt_dblfault_prev_register(struct frame_info *next_frame,
207	void **this_cache, int regnum)
8b6a428f	208	{
f17ea84b SS	209	CORE_ADDR addrp;
	210	struct kgdb_tss_cache *cache;
	211	int ofs;
	212
	213	if (regnum < I386_EAX_REGNUM \|\| regnum > I386_FS_REGNUM)
	214	return frame_unwind_got_register(next_frame, regnum, regnum);
	215
	216	ofs = kgdb_trgt_tss_offset[regnum];
	217
	218	cache = kgdb_trgt_tss_cache(next_frame, this_cache);
	219	if (cache->tss == 0)
	220	return frame_unwind_got_register(next_frame, regnum, regnum);
	221
	222	addrp = cache->tss + ofs;
	223	return frame_unwind_got_memory(next_frame, regnum, addrp);
8b6a428f SS	224	}
8b6a428f SS	225
0c3d3a6f JM	226	static enum unwind_stop_reason
	227	kgdb_trgt_dblfault_unwind_reason(struct frame_info *next_frame,
	228	void **this_cache)
	229	{
	230	/* XXX marino : populate logic to determine unwind stoppage */
	231	return UNWIND_NO_REASON;
	232	}
	233
f17ea84b SS	234	static const struct frame_unwind kgdb_trgt_dblfault_unwind = {
f17ea84b SS	235	NORMAL_FRAME,
0c3d3a6f	236	&kgdb_trgt_dblfault_unwind_reason,
f17ea84b SS	237	&kgdb_trgt_dblfault_this_id,
	238	&kgdb_trgt_dblfault_prev_register,
	239	.sniffer = kgdb_trgt_trapframe_sniffer
	240	};
	241
8b6a428f	242	struct kgdb_frame_cache {
f17ea84b	243	int frame_type;
8b6a428f SS	244	CORE_ADDR pc;
	245	CORE_ADDR sp;
	246	};
f17ea84b SS	247	#define FT_NORMAL 1
	248	#define FT_INTRFRAME 2
	249	/#define FT_INTRTRAPFRAME 3/
	250	#define FT_TIMERFRAME 4
939fa31e	251	#define FT_CALLTRAP 5
8b6a428f SS	252
	253	static int kgdb_trgt_frame_offset[15] = {
	254	offsetof(struct trapframe, tf_eax),
	255	offsetof(struct trapframe, tf_ecx),
	256	offsetof(struct trapframe, tf_edx),
	257	offsetof(struct trapframe, tf_ebx),
	258	offsetof(struct trapframe, tf_esp),
	259	offsetof(struct trapframe, tf_ebp),
	260	offsetof(struct trapframe, tf_esi),
	261	offsetof(struct trapframe, tf_edi),
	262	offsetof(struct trapframe, tf_eip),
	263	offsetof(struct trapframe, tf_eflags),
	264	offsetof(struct trapframe, tf_cs),
	265	offsetof(struct trapframe, tf_ss),
	266	offsetof(struct trapframe, tf_ds),
	267	offsetof(struct trapframe, tf_es),
	268	offsetof(struct trapframe, tf_fs)
	269	};
	270
	271	static struct kgdb_frame_cache *
	272	kgdb_trgt_frame_cache(struct frame_info next_frame, void *this_cache)
	273	{
8b6a428f SS	274	struct kgdb_frame_cache *cache;
	275	char *pname;
	276
	277	cache = *this_cache;
	278	if (cache == NULL) {
	279	cache = FRAME_OBSTACK_ZALLOC(struct kgdb_frame_cache);
	280	*this_cache = cache;
0c3d4888	281	cache->pc = get_frame_address_in_block(next_frame);
939fa31e	282	cache->sp = get_frame_sp(next_frame);
8b6a428f	283	find_pc_partial_function(cache->pc, &pname, NULL, NULL);
cf759448	284
939fa31e MD	285	if (strcmp(pname, "calltrap") == 0)
	286	cache->frame_type = FT_CALLTRAP;
	287	else if (pname[0] != 'X')
f17ea84b SS	288	cache->frame_type = FT_NORMAL;
	289	else if (strcmp(pname, "Xtimerint") == 0)
	290	cache->frame_type = FT_TIMERFRAME;
	291	/* else if (strcmp(pname, "Xcpustop") == 0 \|\|
	292	strcmp(pname, "Xrendezvous") == 0 \|\|
	293	strcmp(pname, "Xipi_intr_bitmap_handler") == 0 \|\|
	294	strcmp(pname, "Xlazypmap") == 0)
	295	cache->frame_type = FT_INTRTRAPFRAME;
	296	*/
	297	else
	298	cache->frame_type = FT_INTRFRAME;
8b6a428f SS	299	}
	300	return (cache);
	301	}
	302
	303	static void
	304	kgdb_trgt_trapframe_this_id(struct frame_info next_frame, void *this_cache,
	305	struct frame_id *this_id)
	306	{
	307	struct kgdb_frame_cache *cache;
	308
	309	cache = kgdb_trgt_frame_cache(next_frame, this_cache);
	310	*this_id = frame_id_build(cache->sp, cache->pc);
	311	}
	312
f17ea84b	313	static struct value *
8b6a428f	314	kgdb_trgt_trapframe_prev_register(struct frame_info *next_frame,
f17ea84b	315	void **this_cache, int regnum)
8b6a428f	316	{
f17ea84b	317	CORE_ADDR addrp;
8b6a428f	318	struct kgdb_frame_cache *cache;
f17ea84b	319	int ofs;
8b6a428f SS	320
8b6a428f SS	321	if (regnum < I386_EAX_REGNUM \|\| regnum > I386_FS_REGNUM)
f17ea84b SS	322	return frame_unwind_got_register(next_frame, regnum, regnum);
	323
	324	ofs = kgdb_trgt_frame_offset[regnum] + 4;
8b6a428f SS	325
8b6a428f SS	326	cache = kgdb_trgt_frame_cache(next_frame, this_cache);
939fa31e	327
f17ea84b SS	328	switch (cache->frame_type) {
	329	case FT_NORMAL:
	330	break;
	331	case FT_INTRFRAME:
	332	ofs += 4;
	333	break;
	334	case FT_TIMERFRAME:
	335	break;
	336	/*
	337	case FT_INTRTRAPFRAME:
	338	ofs -= ofs_fix;
	339	break;
	340	*/
939fa31e MD	341	case FT_CALLTRAP:
	342	ofs += 0;
	343	break;
f17ea84b SS	344	default:
	345	fprintf_unfiltered(gdb_stderr, "Correct FT_XXX frame offsets "
	346	"for %d\n", cache->frame_type);
	347	break;
	348	}
8b6a428f	349
f17ea84b	350	addrp = cache->sp + ofs;
8b6a428f	351
f17ea84b	352	#if 0
8b6a428f SS	353	/*
	354	* If we are in the kernel, we don't have esp stored in the
	355	* trapframe, but we can calculate it simply by subtracting
	356	* the size of the frame.
	357	*/
	358	if (regnum == I386_ESP_REGNUM) {
	359	char buf[4];
	360
	361	frame_unwind_register(next_frame, I386_CS_REGNUM, buf);
f17ea84b SS	362	if (extract_unsigned_integer(buf, 4, byte_order) != SEL_UPL)
	363	return frame_unwind_got_address(next_frame, regnum, addrp);
	364	/* else FALLTHROUGH */
8b6a428f	365	}
f17ea84b SS	366	#endif
	367
	368	return frame_unwind_got_memory(next_frame, regnum, addrp);
8b6a428f SS	369	}
8b6a428f SS	370
0c3d3a6f JM	371	static enum unwind_stop_reason
	372	kgdb_trgt_trapframe_unwind_reason(struct frame_info *next_frame,
	373	void **this_cache)
	374	{
	375	/* XXX marino : populate logic to determine unwind stoppage */
	376	return UNWIND_NO_REASON;
	377	}
	378
f17ea84b SS	379	const struct frame_unwind kgdb_trgt_trapframe_unwind = {
f17ea84b SS	380	NORMAL_FRAME,
0c3d3a6f	381	&kgdb_trgt_trapframe_unwind_reason,
f17ea84b SS	382	&kgdb_trgt_trapframe_this_id,
	383	&kgdb_trgt_trapframe_prev_register,
	384	.sniffer = kgdb_trgt_trapframe_sniffer
	385	};
	386
8b6a428f SS	387	static int
	388	kgdb_trgt_trapframe_sniffer(const struct frame_unwind *self,
	389	struct frame_info *next_frame,
	390	void **this_prologue_cache)
	391	{
	392	char *pname;
	393	CORE_ADDR pc;
	394
f17ea84b	395	pc = get_frame_address_in_block(next_frame);
8b6a428f SS	396	pname = NULL;
	397	find_pc_partial_function(pc, &pname, NULL, NULL);
	398	if (pname == NULL)
3641b7ca	399	return (0);
f17ea84b SS	400
	401	/*
	402	* This is a combined sniffer, since only the
	403	* function names change.
	404	*/
	405
	406	/*
	407	* If we're the sniffer for a trapframe, deal with
	408	* all these function names.
	409	*/
	410	if (self == &kgdb_trgt_trapframe_unwind &&
	411	(strcmp(pname, "calltrap") == 0 \|\|
	412	(pname[0] == 'X' && pname[1] != '_')))
	413	return (1);
	414
	415	/*
	416	* If we're a double fault sniffer, only look for
	417	* the double fault name.
	418	*/
	419	if(self == &kgdb_trgt_dblfault_unwind &&
	420	strcmp(pname, "dblfault_handler") == 0)
	421	return (1);
	422
8b6a428f	423	/* printf("%s: %llx =%s\n", __func__, pc, pname); */
f17ea84b	424	return (0);
8b6a428f	425	}