/*
- * Copyright (c) 2000-2007 Apple Computer, Inc. All rights reserved.
+ * Copyright (c) 2000-2012 Apple Inc. All rights reserved.
*
* @APPLE_OSREFERENCE_LICENSE_HEADER_START@
*
*/
#include <mach/mach_types.h>
+#include <mach/vm_param.h>
+#include <sys/appleapiopts.h>
#include <kern/debug.h>
+#include <uuid/uuid.h>
#include <kdp/kdp_internal.h>
#include <kdp/kdp_private.h>
+#include <kdp/kdp_core.h>
#include <libsa/types.h>
+#include <libkern/version.h>
#include <string.h> /* bcopy */
#include <kern/processor.h>
#include <kern/thread.h>
+#include <kern/clock.h>
#include <vm/vm_map.h>
#include <vm/vm_kern.h>
-
-int kdp_vm_read( caddr_t, caddr_t, unsigned int);
-int kdp_vm_write( caddr_t, caddr_t, unsigned int);
+#include <vm/vm_pageout.h>
+#include <vm/vm_shared_region.h>
+#include <libkern/OSKextLibPrivate.h>
#define DO_ALIGN 1 /* align all packet data accesses */
#endif
static kdp_dispatch_t
- dispatch_table[KDP_HOSTREBOOT - KDP_CONNECT +1] =
+ dispatch_table[KDP_INVALID_REQUEST-KDP_CONNECT] =
{
/* 0 */ kdp_connect,
/* 1 */ kdp_disconnect,
/*10 */ kdp_breakpoint_remove,
/*11 */ kdp_regions,
/*12 */ kdp_reattach,
-/*13 */ (kdp_dispatch_t)kdp_reboot
+/*13 */ kdp_reboot,
+/*14 */ kdp_readmem64,
+/*15 */ kdp_writemem64,
+/*16 */ kdp_breakpoint64_set,
+/*17 */ kdp_breakpoint64_remove,
+/*18 */ kdp_kernelversion,
+/*19 */ kdp_readphysmem64,
+/*1A */ kdp_writephysmem64,
+/*1B */ kdp_readioport,
+/*1C */ kdp_writeioport,
+/*1D */ kdp_readmsr64,
+/*1E */ kdp_writemsr64,
+/*1F */ kdp_dumpinfo,
};
kdp_glob_t kdp;
-
#define MAX_BREAKPOINTS 100
-#define KDP_MAX_BREAKPOINTS 100
-
-#define BREAKPOINT_NOT_FOUND 101
-#define BREAKPOINT_ALREADY_SET 102
-#define KDP_VERSION 10
+/*
+ * Version 11 of the KDP Protocol adds support for 64-bit wide memory
+ * addresses (read/write and breakpoints) as well as a dedicated
+ * kernelversion request. Version 12 adds read/writing of physical
+ * memory with 64-bit wide memory addresses.
+ */
+#define KDP_VERSION 12
typedef struct{
- unsigned int address;
- unsigned int old_instruction;
+ mach_vm_address_t address;
+ uint32_t bytesused;
+ uint8_t oldbytes[MAX_BREAKINSN_BYTES];
} kdp_breakpoint_record_t;
static kdp_breakpoint_record_t breakpoint_list[MAX_BREAKPOINTS];
int noresume_on_disconnect = 0;
extern unsigned int return_on_panic;
-#define MAXCOMLEN 16
-
-struct thread_snapshot {
- uint32_t snapshot_magic;
- thread_t thread_id;
- int32_t state;
- wait_queue_t wait_queue;
- event64_t wait_event;
- vm_offset_t kernel_stack;
- vm_offset_t reserved_stack;
- thread_continue_t continuation;
- uint32_t nkern_frames;
- char user64_p;
- uint32_t nuser_frames;
- int32_t pid;
- char p_comm[MAXCOMLEN + 1];
-};
-
-typedef struct thread_snapshot *thread_snapshot_t;
-
-extern int
-machine_trace_thread(thread_t thread, char *tracepos, char *tracebound, int nframes, boolean_t user_p);
-extern int
-machine_trace_thread64(thread_t thread, char *tracepos, char *tracebound, int nframes, boolean_t user_p);
-extern int
-proc_pid(void *p);
-extern void
-proc_name_kdp(task_t task, char *buf, int size);
-
-extern void
-kdp_snapshot_postflight(void);
-
-static int
-pid_from_task(task_t task);
-
-int
-kdp_stackshot(int pid, void *tracebuf, uint32_t tracebuf_size, unsigned trace_options, uint32_t *pbytesTraced);
-
-extern char version[];
+kdp_error_t
+kdp_set_breakpoint_internal(
+ mach_vm_address_t address
+ );
+
+kdp_error_t
+kdp_remove_breakpoint_internal(
+ mach_vm_address_t address
+ );
boolean_t
kdp_packet(
size_t plen = *len;
kdp_req_t req;
boolean_t ret;
-
+
#if DO_ALIGN
- bcopy((char *)pkt, (char *)rd, sizeof(aligned_pkt));
+ if (plen > sizeof(aligned_pkt)) {
+ printf("kdp_packet bad len %lu\n", plen);
+ return FALSE;
+ }
+ bcopy((char *)pkt, (char *)rd, plen);
#else
rd = (kdp_pkt_t *)pkt;
#endif
}
req = rd->hdr.request;
- if (req > KDP_HOSTREBOOT) {
+ if (req >= KDP_INVALID_REQUEST) {
printf("kdp_packet bad request %x len %d seq %x key %x\n",
rd->hdr.request, rd->hdr.len, rd->hdr.seq, rd->hdr.key);
kdp_connect_req_t *rq = &pkt->connect_req;
size_t plen = *len;
kdp_connect_reply_t *rp = &pkt->connect_reply;
+ uint16_t rport, eport;
+ uint32_t key;
+ uint8_t seq;
if (plen < sizeof (*rq))
return (FALSE);
dprintf(("kdp_connect seq %x greeting %s\n", rq->hdr.seq, rq->greeting));
+ rport = rq->req_reply_port;
+ eport = rq->exc_note_port;
+ key = rq->hdr.key;
+ seq = rq->hdr.seq;
if (kdp.is_conn) {
- if (rq->hdr.seq == kdp.conn_seq) /* duplicate request */
+ if ((seq == kdp.conn_seq) && /* duplicate request */
+ (rport == kdp.reply_port) &&
+ (eport == kdp.exception_port) &&
+ (key == kdp.session_key))
rp->error = KDPERR_NO_ERROR;
- else
+ else
rp->error = KDPERR_ALREADY_CONNECTED;
}
else {
- kdp.reply_port = rq->req_reply_port;
- kdp.exception_port = rq->exc_note_port;
- kdp.is_conn = TRUE;
- kdp.conn_seq = rq->hdr.seq;
-
+ kdp.reply_port = rport;
+ kdp.exception_port = eport;
+ kdp.is_conn = TRUE;
+ kdp.conn_seq = seq;
+ kdp.session_key = key;
+
rp->error = KDPERR_NO_ERROR;
}
rp->hdr.is_reply = 1;
rp->hdr.len = sizeof (*rp);
- *reply_port = kdp.reply_port;
+ *reply_port = rport;
*len = rp->hdr.len;
if (current_debugger == KDP_CUR_DB)
kdp.reply_port = kdp.exception_port = 0;
kdp.is_halted = kdp.is_conn = FALSE;
kdp.exception_seq = kdp.conn_seq = 0;
+ kdp.session_key = 0;
if ((panicstr != NULL) && (return_on_panic == 0))
- reattach_wait = 1;
+ reattach_wait = 1;
if (noresume_on_disconnect == 1) {
reattach_wait = 1;
unsigned short *reply_port
)
{
- kdp_reattach_req_t *rq = &pkt->reattach_req;
+ kdp_reattach_req_t *rq = &pkt->reattach_req;
- kdp.is_conn = TRUE;
- kdp_disconnect(pkt, len, reply_port);
- *reply_port = rq->req_reply_port;
- reattach_wait = 1;
- return (TRUE);
+ kdp.is_conn = TRUE;
+ kdp_disconnect(pkt, len, reply_port);
+ *reply_port = rq->req_reply_port;
+ reattach_wait = 1;
+ return (TRUE);
}
static boolean_t
if (plen < sizeof (*rq))
return (FALSE);
+ dprintf(("kdp_hostinfo\n"));
+
rp->hdr.is_reply = 1;
rp->hdr.len = sizeof (*rp);
return (TRUE);
}
+static boolean_t
+kdp_kernelversion(
+ kdp_pkt_t *pkt,
+ int *len,
+ unsigned short *reply_port
+)
+{
+ kdp_kernelversion_req_t *rq = &pkt->kernelversion_req;
+ size_t plen = *len;
+ kdp_kernelversion_reply_t *rp = &pkt->kernelversion_reply;
+ size_t slen;
+
+ if (plen < sizeof (*rq))
+ return (FALSE);
+
+ rp->hdr.is_reply = 1;
+ rp->hdr.len = sizeof (*rp);
+
+ dprintf(("kdp_kernelversion\n"));
+ slen = strlcpy(rp->version, kdp_kernelversion_string, MAX_KDP_DATA_SIZE);
+
+ rp->hdr.len += slen + 1; /* strlcpy returns the amount copied with NUL */
+
+ *reply_port = kdp.reply_port;
+ *len = rp->hdr.len;
+
+ return (TRUE);
+}
+
static boolean_t
kdp_suspend(
kdp_pkt_t *pkt,
kdp_writemem_req_t *rq = &pkt->writemem_req;
size_t plen = *len;
kdp_writemem_reply_t *rp = &pkt->writemem_reply;
- int cnt;
+ mach_vm_size_t cnt;
if (plen < sizeof (*rq))
return (FALSE);
rp->error = KDPERR_BAD_NBYTES;
else {
dprintf(("kdp_writemem addr %x size %d\n", rq->address, rq->nbytes));
-
- cnt = kdp_vm_write((caddr_t)rq->data, (caddr_t)rq->address, rq->nbytes);
- rp->error = KDPERR_NO_ERROR;
+ cnt = kdp_machine_vm_write((caddr_t)rq->data, (mach_vm_address_t)rq->address, rq->nbytes);
+ rp->error = KDPERR_ACCESS(rq->nbytes, cnt);
+ dprintf((" cnt %lld error %d\n", cnt, rp->error));
}
rp->hdr.is_reply = 1;
return (TRUE);
}
+static boolean_t
+kdp_writemem64(
+ kdp_pkt_t *pkt,
+ int *len,
+ unsigned short *reply_port
+)
+{
+ kdp_writemem64_req_t *rq = &pkt->writemem64_req;
+ size_t plen = *len;
+ kdp_writemem64_reply_t *rp = &pkt->writemem64_reply;
+ mach_vm_size_t cnt;
+
+ if (plen < sizeof (*rq))
+ return (FALSE);
+
+ if (rq->nbytes > MAX_KDP_DATA_SIZE)
+ rp->error = KDPERR_BAD_NBYTES;
+ else {
+ dprintf(("kdp_writemem64 addr %llx size %d\n", rq->address, rq->nbytes));
+ cnt = kdp_machine_vm_write((caddr_t)rq->data, (mach_vm_address_t)rq->address, (mach_vm_size_t)rq->nbytes);
+ rp->error = KDPERR_ACCESS(rq->nbytes, cnt);
+ dprintf((" cnt %lld error %d\n", cnt, rp->error));
+ }
+
+ rp->hdr.is_reply = 1;
+ rp->hdr.len = sizeof (*rp);
+
+ *reply_port = kdp.reply_port;
+ *len = rp->hdr.len;
+
+ return (TRUE);
+}
+
+static boolean_t
+kdp_writephysmem64(
+ kdp_pkt_t *pkt,
+ int *len,
+ unsigned short *reply_port
+)
+{
+ kdp_writephysmem64_req_t *rq = &pkt->writephysmem64_req;
+ size_t plen = *len;
+ kdp_writephysmem64_reply_t *rp = &pkt->writephysmem64_reply;
+ mach_vm_size_t cnt;
+ unsigned int size;
+
+ if (plen < sizeof (*rq))
+ return (FALSE);
+
+ size = rq->nbytes;
+ if (size > MAX_KDP_DATA_SIZE)
+ rp->error = KDPERR_BAD_NBYTES;
+ else {
+ dprintf(("kdp_writephysmem64 addr %llx size %d\n", rq->address, size));
+ cnt = kdp_machine_phys_write(rq, rq->data, rq->lcpu);
+ rp->error = KDPERR_ACCESS(size, cnt);
+ dprintf((" cnt %lld error %d\n", cnt, rp->error));
+ }
+
+ rp->hdr.is_reply = 1;
+ rp->hdr.len = sizeof (*rp);
+
+ *reply_port = kdp.reply_port;
+ *len = rp->hdr.len;
+
+ return (TRUE);
+}
+
static boolean_t
kdp_readmem(
kdp_pkt_t *pkt,
kdp_readmem_req_t *rq = &pkt->readmem_req;
size_t plen = *len;
kdp_readmem_reply_t *rp = &pkt->readmem_reply;
- int cnt;
-#if __i386__ || __arm__
- void *pversion = &version;
-#endif
+ mach_vm_size_t cnt;
+ unsigned int size;
+
if (plen < sizeof (*rq))
return (FALSE);
rp->hdr.is_reply = 1;
rp->hdr.len = sizeof (*rp);
- if (rq->nbytes > MAX_KDP_DATA_SIZE)
+ size = rq->nbytes;
+ if (size > MAX_KDP_DATA_SIZE)
rp->error = KDPERR_BAD_NBYTES;
else {
- unsigned int n = rq->nbytes;
-
- dprintf(("kdp_readmem addr %x size %d\n", rq->address, n));
-#if __i386__ || __arm__
- /* XXX This is a hack to facilitate the "showversion" macro
- * on i386/ARM, which is used to obtain the kernel version without
- * symbols - a pointer to the version string should eventually
- * be pinned at a fixed address when an equivalent of the
- * VECTORS segment (loaded at a fixed load address, and contains
- * a table) is implemented on these architectures, as with PPC.
- * N.B.: x86 now has a low global page, and the version indirection
- * is pinned at 0x201C. We retain the 0x501C address override
- * for compatibility.
- */
- if (rq->address == (void *)0x501C)
- rq->address = &pversion;
-#endif
- cnt = kdp_vm_read((caddr_t)rq->address, (caddr_t)rp->data, n);
- rp->error = KDPERR_NO_ERROR;
+ dprintf(("kdp_readmem addr %x size %d\n", rq->address, size));
+ cnt = kdp_machine_vm_read((mach_vm_address_t)rq->address, (caddr_t)rp->data, rq->nbytes);
+ rp->error = KDPERR_ACCESS(size, cnt);
+ dprintf((" cnt %lld error %d\n", cnt, rp->error));
+
+ rp->hdr.len += cnt;
+ }
+
+ *reply_port = kdp.reply_port;
+ *len = rp->hdr.len;
+
+ return (TRUE);
+}
+
+static boolean_t
+kdp_readmem64(
+ kdp_pkt_t *pkt,
+ int *len,
+ unsigned short *reply_port
+)
+{
+ kdp_readmem64_req_t *rq = &pkt->readmem64_req;
+ size_t plen = *len;
+ kdp_readmem64_reply_t *rp = &pkt->readmem64_reply;
+ mach_vm_size_t cnt;
+ unsigned int size;
+ if (plen < sizeof (*rq))
+ return (FALSE);
+
+ rp->hdr.is_reply = 1;
+ rp->hdr.len = sizeof (*rp);
+
+ size = rq->nbytes;
+ if (size > MAX_KDP_DATA_SIZE)
+ rp->error = KDPERR_BAD_NBYTES;
+ else {
+ dprintf(("kdp_readmem64 addr %llx size %d\n", rq->address, size));
+ cnt = kdp_machine_vm_read((mach_vm_address_t)rq->address, (caddr_t)rp->data, rq->nbytes);
+ rp->error = KDPERR_ACCESS(size, cnt);
+ dprintf((" cnt %lld error %d\n", cnt, rp->error));
+
rp->hdr.len += cnt;
}
+
+ *reply_port = kdp.reply_port;
+ *len = rp->hdr.len;
+
+ return (TRUE);
+}
+static boolean_t
+kdp_readphysmem64(
+ kdp_pkt_t *pkt,
+ int *len,
+ unsigned short *reply_port
+)
+{
+ kdp_readphysmem64_req_t *rq = &pkt->readphysmem64_req;
+ size_t plen = *len;
+ kdp_readphysmem64_reply_t *rp = &pkt->readphysmem64_reply;
+ mach_vm_size_t cnt;
+ unsigned int size;
+
+ if (plen < sizeof (*rq))
+ return (FALSE);
+
+ rp->hdr.is_reply = 1;
+ rp->hdr.len = sizeof (*rp);
+
+ size = rq->nbytes;
+ if (size > MAX_KDP_DATA_SIZE)
+ rp->error = KDPERR_BAD_NBYTES;
+ else {
+ dprintf(("kdp_readphysmem64 addr %llx size %d\n", rq->address, size));
+ cnt = kdp_machine_phys_read(rq, rp->data, rq->lcpu);
+ rp->error = KDPERR_ACCESS(size, cnt);
+ dprintf((" cnt %lld error %d\n", cnt, rp->error));
+
+ rp->hdr.len += cnt;
+ }
+
*reply_port = kdp.reply_port;
*len = rp->hdr.len;
dprintf(("kdp_version\n"));
rp->version = KDP_VERSION;
-#if __ppc__
if (!(kdp_flag & KDP_BP_DIS))
rp->feature = KDP_FEATURE_BP;
else
rp->feature = 0;
-#else
- rp->feature = 0;
-#endif
-
+
*reply_port = kdp.reply_port;
*len = rp->hdr.len;
r = rp->regions;
rp->nregions = 0;
- r->address = NULL;
+ r->address = 0;
r->nbytes = 0xffffffff;
r->protection = VM_PROT_ALL; r++; rp->nregions++;
if (plen < sizeof (*rq))
return (FALSE);
- size = rq->hdr.len - sizeof(kdp_hdr_t) - sizeof(unsigned int);
+ size = rq->hdr.len - (unsigned)sizeof(kdp_hdr_t) - (unsigned)sizeof(unsigned int);
rp->error = kdp_machine_write_regs(rq->cpu, rq->flavor, rq->data, &size);
rp->hdr.is_reply = 1;
return (TRUE);
}
-static boolean_t
+
+boolean_t
kdp_breakpoint_set(
kdp_pkt_t *pkt,
int *len,
unsigned short *reply_port
)
{
- kdp_breakpoint_req_t *rq = &pkt->breakpoint_req;
- kdp_breakpoint_reply_t *rp = &pkt->breakpoint_reply;
- size_t plen = *len;
- int cnt, i;
- unsigned int old_instruction = 0;
- unsigned int breakinstr = kdp_ml_get_breakinsn();
-
- if(breakpoints_initialized == 0)
- {
- for(i=0;(i < MAX_BREAKPOINTS); breakpoint_list[i].address=0, i++);
- breakpoints_initialized++;
- }
- if (plen < sizeof (*rq))
- return (FALSE);
- cnt = kdp_vm_read((caddr_t)rq->address, (caddr_t)(&old_instruction), sizeof(int));
-
- if (old_instruction==breakinstr)
- {
- printf("A trap was already set at that address, not setting new breakpoint\n");
- rp->error = BREAKPOINT_ALREADY_SET;
-
- rp->hdr.is_reply = 1;
- rp->hdr.len = sizeof (*rp);
- *reply_port = kdp.reply_port;
- *len = rp->hdr.len;
-
- return (TRUE);
- }
+ kdp_breakpoint_req_t *rq = &pkt->breakpoint_req;
+ kdp_breakpoint_reply_t *rp = &pkt->breakpoint_reply;
+ size_t plen = *len;
+ kdp_error_t kerr;
+
+ if (plen < sizeof (*rq))
+ return (FALSE);
+
+ dprintf(("kdp_breakpoint_set %x\n", rq->address));
- for(i=0;(i < MAX_BREAKPOINTS) && (breakpoint_list[i].address != 0); i++);
+ kerr = kdp_set_breakpoint_internal((mach_vm_address_t)rq->address);
+
+ rp->error = kerr;
+
+ rp->hdr.is_reply = 1;
+ rp->hdr.len = sizeof (*rp);
+ *reply_port = kdp.reply_port;
+ *len = rp->hdr.len;
+
+ return (TRUE);
+}
- if (i == MAX_BREAKPOINTS)
- {
- rp->error = KDP_MAX_BREAKPOINTS;
-
- rp->hdr.is_reply = 1;
- rp->hdr.len = sizeof (*rp);
- *reply_port = kdp.reply_port;
- *len = rp->hdr.len;
-
- return (TRUE);
- }
- breakpoint_list[i].address = rq->address;
- breakpoint_list[i].old_instruction = old_instruction;
+boolean_t
+kdp_breakpoint64_set(
+ kdp_pkt_t *pkt,
+ int *len,
+ unsigned short *reply_port
+)
+{
+ kdp_breakpoint64_req_t *rq = &pkt->breakpoint64_req;
+ kdp_breakpoint64_reply_t *rp = &pkt->breakpoint64_reply;
+ size_t plen = *len;
+ kdp_error_t kerr;
+
+ if (plen < sizeof (*rq))
+ return (FALSE);
+
+ dprintf(("kdp_breakpoint64_set %llx\n", rq->address));
- cnt = kdp_vm_write((caddr_t)&breakinstr, (caddr_t)rq->address, sizeof(&breakinstr));
+ kerr = kdp_set_breakpoint_internal((mach_vm_address_t)rq->address);
+
+ rp->error = kerr;
+
+ rp->hdr.is_reply = 1;
+ rp->hdr.len = sizeof (*rp);
+ *reply_port = kdp.reply_port;
+ *len = rp->hdr.len;
+
+ return (TRUE);
+}
- rp->error = KDPERR_NO_ERROR;
- rp->hdr.is_reply = 1;
- rp->hdr.len = sizeof (*rp);
- *reply_port = kdp.reply_port;
- *len = rp->hdr.len;
+boolean_t
+kdp_breakpoint_remove(
+ kdp_pkt_t *pkt,
+ int *len,
+ unsigned short *reply_port
+)
+{
+ kdp_breakpoint_req_t *rq = &pkt->breakpoint_req;
+ kdp_breakpoint_reply_t *rp = &pkt->breakpoint_reply;
+ size_t plen = *len;
+ kdp_error_t kerr;
+ if (plen < sizeof (*rq))
+ return (FALSE);
+
+ dprintf(("kdp_breakpoint_remove %x\n", rq->address));
- return (TRUE);
+ kerr = kdp_remove_breakpoint_internal((mach_vm_address_t)rq->address);
+
+ rp->error = kerr;
+
+ rp->hdr.is_reply = 1;
+ rp->hdr.len = sizeof (*rp);
+ *reply_port = kdp.reply_port;
+ *len = rp->hdr.len;
+
+ return (TRUE);
}
-static boolean_t
-kdp_breakpoint_remove(
+boolean_t
+kdp_breakpoint64_remove(
kdp_pkt_t *pkt,
int *len,
unsigned short *reply_port
)
{
- kdp_breakpoint_req_t *rq = &pkt->breakpoint_req;
- kdp_breakpoint_reply_t *rp = &pkt->breakpoint_reply;
- size_t plen = *len;
- int cnt,i;
+ kdp_breakpoint64_req_t *rq = &pkt->breakpoint64_req;
+ kdp_breakpoint64_reply_t *rp = &pkt->breakpoint64_reply;
+ size_t plen = *len;
+ kdp_error_t kerr;
+
+ if (plen < sizeof (*rq))
+ return (FALSE);
+
+ dprintf(("kdp_breakpoint64_remove %llx\n", rq->address));
- if (plen < sizeof (*rq))
- return (FALSE);
+ kerr = kdp_remove_breakpoint_internal((mach_vm_address_t)rq->address);
+
+ rp->error = kerr;
+
+ rp->hdr.is_reply = 1;
+ rp->hdr.len = sizeof (*rp);
+ *reply_port = kdp.reply_port;
+ *len = rp->hdr.len;
+
+ return (TRUE);
+}
- for(i=0;(i < MAX_BREAKPOINTS) && (breakpoint_list[i].address != rq->address); i++);
- if (i == MAX_BREAKPOINTS)
- {
- rp->error = BREAKPOINT_NOT_FOUND;
- rp->hdr.is_reply = 1;
- rp->hdr.len = sizeof (*rp);
- *reply_port = kdp.reply_port;
- *len = rp->hdr.len;
- return (TRUE); /* Check if it needs to be FALSE in case of error */
+kdp_error_t
+kdp_set_breakpoint_internal(
+ mach_vm_address_t address
+)
+{
+
+ uint8_t breakinstr[MAX_BREAKINSN_BYTES], oldinstr[MAX_BREAKINSN_BYTES];
+ uint32_t breakinstrsize = sizeof(breakinstr);
+ mach_vm_size_t cnt;
+ int i;
+
+ kdp_machine_get_breakinsn(breakinstr, &breakinstrsize);
+
+ if(breakpoints_initialized == 0)
+ {
+ for(i=0;(i < MAX_BREAKPOINTS); breakpoint_list[i].address=0, i++);
+ breakpoints_initialized++;
}
+
+ cnt = kdp_machine_vm_read(address, (caddr_t)&oldinstr, (mach_vm_size_t)breakinstrsize);
+
+ if (0 == memcmp(oldinstr, breakinstr, breakinstrsize)) {
+ printf("A trap was already set at that address, not setting new breakpoint\n");
+
+ return KDPERR_BREAKPOINT_ALREADY_SET;
+ }
+
+ for(i=0;(i < MAX_BREAKPOINTS) && (breakpoint_list[i].address != 0); i++);
+
+ if (i == MAX_BREAKPOINTS) {
+ return KDPERR_MAX_BREAKPOINTS;
+ }
+
+ breakpoint_list[i].address = address;
+ memcpy(breakpoint_list[i].oldbytes, oldinstr, breakinstrsize);
+ breakpoint_list[i].bytesused = breakinstrsize;
+
+ cnt = kdp_machine_vm_write((caddr_t)&breakinstr, address, breakinstrsize);
+
+ return KDPERR_NO_ERROR;
+}
- breakpoint_list[i].address = 0;
- cnt = kdp_vm_write((caddr_t)&(breakpoint_list[i].old_instruction), (caddr_t)rq->address, sizeof(int));
- rp->error = KDPERR_NO_ERROR;
- rp->hdr.is_reply = 1;
- rp->hdr.len = sizeof (*rp);
- *reply_port = kdp.reply_port;
- *len = rp->hdr.len;
-
- return (TRUE);
+kdp_error_t
+kdp_remove_breakpoint_internal(
+ mach_vm_address_t address
+)
+{
+ mach_vm_size_t cnt;
+ int i;
+
+ for(i=0;(i < MAX_BREAKPOINTS) && (breakpoint_list[i].address != address); i++);
+
+ if (i == MAX_BREAKPOINTS)
+ {
+ return KDPERR_BREAKPOINT_NOT_FOUND;
+ }
+
+ breakpoint_list[i].address = 0;
+ cnt = kdp_machine_vm_write((caddr_t)&breakpoint_list[i].oldbytes, address, breakpoint_list[i].bytesused);
+
+ return KDPERR_NO_ERROR;
}
boolean_t
kdp_remove_all_breakpoints(void)
{
- int i;
- boolean_t breakpoint_found = FALSE;
-
- if (breakpoints_initialized)
- {
- for(i=0;i < MAX_BREAKPOINTS; i++)
+ int i;
+ boolean_t breakpoint_found = FALSE;
+
+ if (breakpoints_initialized)
{
- if (breakpoint_list[i].address)
- {
- kdp_vm_write((caddr_t)&(breakpoint_list[i].old_instruction), (caddr_t)breakpoint_list[i].address, sizeof(int));
- breakpoint_found = TRUE;
- breakpoint_list[i].address = 0;
- }
- }
- if (breakpoint_found)
- printf("kdp_remove_all_breakpoints: found extant breakpoints, removing them.\n");
- }
- return breakpoint_found;
-}
-
-
-#define MAX_FRAMES 1000
-
-static int pid_from_task(task_t task)
-{
- int pid = -1;
-
- if (task->bsd_info)
- pid = proc_pid(task->bsd_info);
-
- return pid;
-}
-
-int
-kdp_stackshot(int pid, void *tracebuf, uint32_t tracebuf_size, unsigned trace_options, uint32_t *pbytesTraced)
-{
- char *tracepos = (char *) tracebuf;
- char *tracebound = tracepos + tracebuf_size;
- uint32_t tracebytes = 0;
- int error = 0;
-
- task_t task = TASK_NULL;
- thread_t thread = THREAD_NULL;
- int nframes = trace_options;
- thread_snapshot_t tsnap = NULL;
- unsigned framesize = 2 * sizeof(vm_offset_t);
- struct task ctask;
- struct thread cthread;
-
- if ((nframes <= 0) || nframes > MAX_FRAMES)
- nframes = MAX_FRAMES;
-
- queue_iterate(&tasks, task, task_t, tasks) {
- if ((task == NULL) || (ml_nofault_copy((vm_offset_t) task, (vm_offset_t) &ctask, sizeof(struct task)) != sizeof(struct task)))
- goto error_exit;
- /* Trace everything, unless a process was specified */
- if ((pid == -1) || (pid == pid_from_task(task)))
- queue_iterate(&task->threads, thread, thread_t, task_threads){
- if ((thread == NULL) || (ml_nofault_copy((vm_offset_t) thread, (vm_offset_t) &cthread, sizeof(struct thread)) != sizeof(struct thread)))
- goto error_exit;
- if (((tracepos + 4 * sizeof(struct thread_snapshot)) > tracebound)) {
- error = -1;
- goto error_exit;
- }
-/* Populate the thread snapshot header */
- tsnap = (thread_snapshot_t) tracepos;
- tsnap->thread_id = thread;
- tsnap->state = thread->state;
- tsnap->wait_queue = thread->wait_queue;
- tsnap->wait_event = thread->wait_event;
- tsnap->kernel_stack = thread->kernel_stack;
- tsnap->reserved_stack = thread->reserved_stack;
- tsnap->continuation = thread->continuation;
-/* Add the BSD process identifiers */
- if ((tsnap->pid = pid_from_task(task)) != -1)
- proc_name_kdp(task, tsnap->p_comm, MAXCOMLEN + 1);
- else
- tsnap->p_comm[0] = '\0';
-
- tsnap->snapshot_magic = 0xfeedface;
- tracepos += sizeof(struct thread_snapshot);
-
-/* Call through to the machine specific trace routines
- * Frames are added past the snapshot header.
- */
- if (tsnap->kernel_stack != 0)
- tracebytes = machine_trace_thread(thread, tracepos, tracebound, nframes, FALSE);
- tsnap->nkern_frames = tracebytes/(2 * sizeof(vm_offset_t));
- tracepos += tracebytes;
- tracebytes = 0;
- tsnap->user64_p = 0;
-/* Trace user stack, if any */
- if (thread->task->map != kernel_map) {
-/* 64-bit task? */
- if (task_has_64BitAddr(thread->task)) {
- tracebytes = machine_trace_thread64(thread, tracepos, tracebound, nframes, TRUE);
- tsnap->user64_p = 1;
- framesize = 2 * sizeof(addr64_t);
- }
- else {
- tracebytes = machine_trace_thread(thread, tracepos, tracebound, nframes, TRUE);
- framesize = 2 * sizeof(vm_offset_t);
- }
- }
- tsnap->nuser_frames = tracebytes/framesize;
- tracepos += tracebytes;
- tracebytes = 0;
+ for(i=0;i < MAX_BREAKPOINTS; i++)
+ {
+ if (breakpoint_list[i].address)
+ {
+ kdp_machine_vm_write((caddr_t)&(breakpoint_list[i].oldbytes), (mach_vm_address_t)breakpoint_list[i].address, (mach_vm_size_t)breakpoint_list[i].bytesused);
+ breakpoint_found = TRUE;
+ breakpoint_list[i].address = 0;
}
+ }
+
+ if (breakpoint_found)
+ printf("kdp_remove_all_breakpoints: found extant breakpoints, removing them.\n");
+ }
+ return breakpoint_found;
+}
+
+boolean_t
+kdp_reboot(
+ __unused kdp_pkt_t *pkt,
+ __unused int *len,
+ __unused unsigned short *reply_port
+)
+{
+ dprintf(("kdp_reboot\n"));
+
+ kdp_machine_reboot();
+
+ return (TRUE); // no, not really, we won't return
+}
+
+static boolean_t
+kdp_readioport(
+ kdp_pkt_t *pkt,
+ int *len,
+ unsigned short *reply_port
+ )
+{
+ kdp_readioport_req_t *rq = &pkt->readioport_req;
+ kdp_readioport_reply_t *rp = &pkt->readioport_reply;
+ size_t plen = *len;
+
+ if (plen < sizeof (*rq))
+ return (FALSE);
+
+ rp->hdr.is_reply = 1;
+ rp->hdr.len = sizeof (*rp);
+
+ if (rq->nbytes > MAX_KDP_DATA_SIZE)
+ rp->error = KDPERR_BAD_NBYTES;
+ else {
+#if KDP_TEST_HARNESS
+ uint16_t addr = rq->address;
+#endif
+ uint16_t size = rq->nbytes;
+ dprintf(("kdp_readioport addr %x size %d\n", addr, size));
+
+ rp->error = kdp_machine_ioport_read(rq, rp->data, rq->lcpu);
+ if (rp->error == KDPERR_NO_ERROR)
+ rp->hdr.len += size;
+ }
+
+ *reply_port = kdp.reply_port;
+ *len = rp->hdr.len;
+
+ return (TRUE);
+}
+
+static boolean_t
+kdp_writeioport(
+ kdp_pkt_t *pkt,
+ int *len,
+ unsigned short *reply_port
+ )
+{
+ kdp_writeioport_req_t *rq = &pkt->writeioport_req;
+ kdp_writeioport_reply_t *rp = &pkt->writeioport_reply;
+ size_t plen = *len;
+
+ if (plen < sizeof (*rq))
+ return (FALSE);
+
+ if (rq->nbytes > MAX_KDP_DATA_SIZE)
+ rp->error = KDPERR_BAD_NBYTES;
+ else {
+ dprintf(("kdp_writeioport addr %x size %d\n", rq->address,
+ rq->nbytes));
+
+ rp->error = kdp_machine_ioport_write(rq, rq->data, rq->lcpu);
}
+
+ rp->hdr.is_reply = 1;
+ rp->hdr.len = sizeof (*rp);
+
+ *reply_port = kdp.reply_port;
+ *len = rp->hdr.len;
+
+ return (TRUE);
+}
-error_exit:
- /* Release stack snapshot wait indicator */
- kdp_snapshot_postflight();
+static boolean_t
+kdp_readmsr64(
+ kdp_pkt_t *pkt,
+ int *len,
+ unsigned short *reply_port
+)
+{
+ kdp_readmsr64_req_t *rq = &pkt->readmsr64_req;
+ kdp_readmsr64_reply_t *rp = &pkt->readmsr64_reply;
+ size_t plen = *len;
- *pbytesTraced = tracepos - (char *) tracebuf;
+ if (plen < sizeof (*rq))
+ return (FALSE);
+
+ rp->hdr.is_reply = 1;
+ rp->hdr.len = sizeof (*rp);
+
+ dprintf(("kdp_readmsr64 lcpu %x addr %x\n", rq->lcpu, rq->address));
+ rp->error = kdp_machine_msr64_read(rq, rp->data, rq->lcpu);
+ if (rp->error == KDPERR_NO_ERROR)
+ rp->hdr.len += sizeof(uint64_t);
+
+ *reply_port = kdp.reply_port;
+ *len = rp->hdr.len;
+
+ return (TRUE);
+}
- return error;
+static boolean_t
+kdp_writemsr64(
+ kdp_pkt_t *pkt,
+ int *len,
+ unsigned short *reply_port
+ )
+{
+ kdp_writemsr64_req_t *rq = &pkt->writemsr64_req;
+ kdp_writemsr64_reply_t *rp = &pkt->writemsr64_reply;
+ size_t plen = *len;
+
+ if (plen < sizeof (*rq))
+ return (FALSE);
+
+ dprintf(("kdp_writemsr64 lcpu %x addr %x\n", rq->lcpu, rq->address));
+ rp->error = kdp_machine_msr64_write(rq, rq->data, rq->lcpu);
+
+ rp->hdr.is_reply = 1;
+ rp->hdr.len = sizeof (*rp);
+
+ *reply_port = kdp.reply_port;
+ *len = rp->hdr.len;
+
+ return (TRUE);
}
+
+static boolean_t
+kdp_dumpinfo(
+ kdp_pkt_t *pkt,
+ int *len,
+ unsigned short *reply_port
+ )
+{
+ kdp_dumpinfo_req_t *rq = &pkt->dumpinfo_req;
+ kdp_dumpinfo_reply_t *rp = &pkt->dumpinfo_reply;
+ size_t plen = *len;
+
+ if (plen < sizeof (*rq))
+ return (FALSE);
+
+ dprintf(("kdp_dumpinfo file=%s destip=%s routerip=%s\n", rq->name, rq->destip, rq->routerip));
+ rp->hdr.is_reply = 1;
+ rp->hdr.len = sizeof (*rp);
+
+ if ((rq->type & KDP_DUMPINFO_MASK) != KDP_DUMPINFO_GETINFO) {
+ kdp_set_dump_info(rq->type, rq->name, rq->destip, rq->routerip,
+ rq->port);
+ }
+
+ /* gather some stats for reply */
+ kdp_get_dump_info(rp);
+
+ *reply_port = kdp.reply_port;
+ *len = rp->hdr.len;
+
+ return (TRUE);
+}
+
projects / apple / xnu.git / blobdiff