#include <mach/mach_types.h>
#include <mach/vm_attributes.h>
#include <mach/vm_param.h>
#include <vm/pmap.h>
#include <ppc/proc_reg.h>
#include <ppc/machparam.h>
#include <ppc/mem.h>
#include <ppc/pmap.h>
#include <ppc/mappings.h>
#include <mach/thread_status.h>
#include <mach-o/loader.h>
#include <mach/vm_region.h>
#include <mach/vm_statistics.h>
#include <vm/vm_kern.h>
#include <kdp/kdp_core.h>
#include <kdp/kdp_udp.h>
#include <kdp/kdp_internal.h>
pmap_t kdp_pmap=0;
boolean_t kdp_trans_off=0;
boolean_t kdp_read_io =0;
unsigned kdp_vm_read( caddr_t, caddr_t, unsigned);
unsigned kdp_vm_write( caddr_t, caddr_t, unsigned);
typedef struct {
int flavor;
int count;
} mythread_state_flavor_t;
static mythread_state_flavor_t thread_flavor_array[] = {
{PPC_THREAD_STATE , PPC_THREAD_STATE_COUNT},
};
static int kdp_mynum_flavors = 1;
static int MAX_TSTATE_FLAVORS = 1;
typedef struct {
vm_offset_t header;
int hoffset;
mythread_state_flavor_t *flavors;
int tstate_size;
} tir_t;
unsigned int not_in_kdp = 1;
char command_buffer[512];
static struct vm_object test_object;
addr64_t kdp_vtophys(
pmap_t pmap,
addr64_t va)
{
addr64_t pa;
ppnum_t pp;
pp = pmap_find_phys(pmap, va);
if(!pp) return 0;
pa = ((addr64_t)pp << 12) | (va & 0x0000000000000FFFULL);
return(pa);
}
unsigned kdp_vm_read(
caddr_t src,
caddr_t dst,
unsigned len)
{
addr64_t cur_virt_src, cur_virt_dst;
addr64_t cur_phys_src;
unsigned resid, cnt;
unsigned int dummy;
pmap_t pmap;
#ifdef KDP_VM_READ_DEBUG
kprintf("kdp_vm_read1: src %x dst %x len %x - %08X %08X\n", src, dst, len, ((unsigned long *)src)[0], ((unsigned long *)src)[1]);
#endif
cur_virt_src = (addr64_t)((unsigned int)src);
cur_virt_dst = (addr64_t)((unsigned int)dst);
if (kdp_trans_off) {
resid = len;
while (resid != 0) {
if(kdp_read_io == 0)
if(!mapping_phys_lookup((ppnum_t)(cur_virt_src >> 12), &dummy)) return 0;
cnt = 4096 - (cur_virt_src & 0xFFF);
if (cnt > resid) cnt = resid;
bcopy_phys(cur_virt_src, cur_virt_dst, cnt);
cur_virt_src += cnt;
cur_virt_dst += cnt;
resid -= cnt;
}
} else {
resid = len;
if(kdp_pmap) pmap = kdp_pmap;
else pmap = kernel_pmap;
while (resid != 0) {
if((cur_phys_src = kdp_vtophys(pmap, cur_virt_src)) == 0) goto exit;
if(kdp_read_io == 0)
if(!mapping_phys_lookup((ppnum_t)(cur_phys_src >> 12), &dummy)) goto exit;
cnt = 4096 - (cur_virt_src & 0xFFF);
if (cnt > resid) cnt = resid;
#ifdef KDP_VM_READ_DEBUG
kprintf("kdp_vm_read2: pmap %08X, virt %016LLX, phys %016LLX\n",
pmap, cur_virt_src, cur_phys_src);
#endif
bcopy_phys(cur_phys_src, cur_virt_dst, cnt);
cur_virt_src +=cnt;
cur_virt_dst +=cnt;
resid -= cnt;
}
}
exit:
#ifdef KDP_VM_READ_DEBUG
kprintf("kdp_vm_read: ret %08X\n", len-resid);
#endif
return (len - resid);
}
unsigned kdp_vm_write(
caddr_t src,
caddr_t dst,
unsigned len)
{
addr64_t cur_virt_src, cur_virt_dst;
addr64_t cur_phys_src, cur_phys_dst;
unsigned resid, cnt, cnt_src, cnt_dst;
#ifdef KDP_VM_WRITE_DEBUG
printf("kdp_vm_write: src %x dst %x len %x - %08X %08X\n", src, dst, len, ((unsigned long *)src)[0], ((unsigned long *)src)[1]);
#endif
cur_virt_src = (addr64_t)((unsigned int)src);
cur_virt_dst = (addr64_t)((unsigned int)dst);
resid = len;
while (resid != 0) {
if ((cur_phys_dst = kdp_vtophys(kernel_pmap, cur_virt_dst)) == 0)
goto exit;
if ((cur_phys_src = kdp_vtophys(kernel_pmap, cur_virt_src)) == 0)
goto exit;
cnt_src = ((cur_phys_src + NBPG) & (-NBPG)) - cur_phys_src;
cnt_dst = ((cur_phys_dst + NBPG) & (-NBPG)) - cur_phys_dst;
if (cnt_src > cnt_dst)
cnt = cnt_dst;
else
cnt = cnt_src;
if (cnt > resid)
cnt = resid;
bcopy_phys(cur_phys_src, cur_phys_dst, cnt);
sync_cache64(cur_phys_dst, cnt);
cur_virt_src +=cnt;
cur_virt_dst +=cnt;
resid -= cnt;
}
exit:
return (len - resid);
}
static void
kern_collectth_state(thread_act_t th_act, tir_t *t)
{
vm_offset_t header;
int hoffset, i ;
mythread_state_flavor_t *flavors;
struct thread_command *tc;
header = t->header;
hoffset = t->hoffset;
flavors = t->flavors;
tc = (struct thread_command *) (header + hoffset);
tc->cmd = LC_THREAD;
tc->cmdsize = sizeof(struct thread_command)
+ t->tstate_size;
hoffset += sizeof(struct thread_command);
for (i = 0; i < kdp_mynum_flavors; i++) {
*(mythread_state_flavor_t *)(header+hoffset) =
flavors[i];
hoffset += sizeof(mythread_state_flavor_t);
if (machine_thread_get_kern_state(th_act, flavors[i].flavor,
(thread_state_t) (header+hoffset),
&flavors[i].count) != KERN_SUCCESS)
printf ("Failure in machine_thread_get_kern_state()\n");
hoffset += flavors[i].count*sizeof(int);
}
t->hoffset = hoffset;
}
int
kdp_dump_trap(
int type,
struct savearea *regs)
{
extern int kdp_flag;
printf ("An unexpected trap (type %d) occurred during the kernel dump, terminating.\n", type);
kdp_send_panic_pkt (KDP_EOF, NULL, 0, ((void *) 0));
abort_panic_transfer();
kdp_flag &= ~KDP_PANIC_DUMP_ENABLED;
kdp_flag &= ~PANIC_CORE_ON_NMI;
kdp_flag &= ~PANIC_LOG_DUMP;
kdp_reset();
kdp_raise_exception(EXC_BAD_ACCESS, 0, 0, kdp.saved_state);
return;
}
int
kern_dump()
{
int error = 0;
vm_map_t map;
unsigned int thread_count, segment_count;
unsigned int command_size = 0, header_size = 0, tstate_size = 0;
unsigned int hoffset = 0, foffset = 0, nfoffset = 0, vmoffset = 0;
unsigned int max_header_size = 0;
vm_offset_t header;
struct machine_slot *ms;
struct mach_header *mh;
struct segment_command *sc;
struct thread_command *tc;
vm_size_t size;
vm_prot_t prot = 0;
vm_prot_t maxprot = 0;
vm_inherit_t inherit = 0;
vm_offset_t offset;
int error1;
mythread_state_flavor_t flavors[MAX_TSTATE_FLAVORS];
vm_size_t nflavors;
int i;
int nesting_depth = 0;
kern_return_t kret;
struct vm_region_submap_info_64 vbr;
int vbrcount = 0;
tir_t tir1;
int panic_error = 0;
unsigned int txstart = 0;
unsigned int mach_section_count = 4;
unsigned int num_sects_txed = 0;
extern int SEGSIZE;
extern vm_offset_t sectTEXTB, sectDATAB, sectLINKB, sectPRELINKB;
extern int sectSizeTEXT, sectSizeDATA, sectSizeLINK, sectSizePRELINK;
map = kernel_map;
not_in_kdp = 0;
thread_count = 1;
segment_count = get_vmmap_entries(map);
printf("Kernel map has %d entries\n", segment_count);
nflavors = kdp_mynum_flavors;
bcopy((char *)thread_flavor_array,(char *) flavors,sizeof(thread_flavor_array));
for (i = 0; i < nflavors; i++)
tstate_size += sizeof(mythread_state_flavor_t) +
(flavors[i].count * sizeof(int));
command_size = (segment_count + mach_section_count) *
sizeof(struct segment_command) +
thread_count*sizeof(struct thread_command) +
tstate_size*thread_count;
header_size = command_size + sizeof(struct mach_header);
header = (vm_offset_t) command_buffer;
printf ("Generated Mach-O header size was %d\n", header_size);
mh = (struct mach_header *) header;
ms = &machine_slot[cpu_number()];
mh->magic = MH_MAGIC;
mh->cputype = ms->cpu_type;
mh->cpusubtype = ms->cpu_subtype;
mh->filetype = MH_CORE;
mh->ncmds = segment_count + thread_count + mach_section_count;
mh->sizeofcmds = command_size;
mh->flags = 0;
hoffset = sizeof(struct mach_header);
foffset = round_page_32(header_size);
if ((foffset - header_size) < (4*sizeof(struct segment_command))) {
foffset += ((4*sizeof(struct segment_command)) - (foffset-header_size));
}
max_header_size = foffset;
vmoffset = VM_MIN_ADDRESS;
if ((panic_error = kdp_send_panic_pkt (KDP_SEEK, NULL, sizeof(nfoffset) , &nfoffset)) < 0) {
printf ("kdp_send_panic_pkt failed with error %d\n", panic_error);
return -1;
}
if ((panic_error = kdp_send_panic_packets (KDP_DATA, NULL, sizeof(struct mach_header), (caddr_t) mh) < 0)) {
printf ("kdp_send_panic_packets failed with error %d\n", panic_error);
return -1 ;
}
if ((panic_error = kdp_send_panic_pkt (KDP_SEEK, NULL, sizeof(foffset) , &foffset) < 0)) {
printf ("kdp_send_panic_pkt failed with error %d\n", panic_error);
return (-1);
}
printf ("Transmitting kernel state, please wait: ");
while ((segment_count > 0) || (kret == KERN_SUCCESS)){
if (num_sects_txed == mach_section_count-1) {
while (1) {
vbrcount = VM_REGION_SUBMAP_INFO_COUNT_64;
if((kret = vm_region_recurse_64(map,
&vmoffset, &size, &nesting_depth,
&vbr, &vbrcount)) != KERN_SUCCESS) {
break;
}
if(vbr.is_submap) {
nesting_depth++;
continue;
} else {
break;
}
}
if(kret != KERN_SUCCESS)
break;
prot = vbr.protection;
maxprot = vbr.max_protection;
inherit = vbr.inheritance;
}
else
{
switch (num_sects_txed) {
case 0:
{
vmoffset = sectTEXTB;
size = sectSizeTEXT;
}
break;
case 1:
{
vmoffset = sectDATAB;
size = sectSizeDATA;
}
break;
case 2:
{
vmoffset = sectPRELINKB;
size = sectSizePRELINK;
}
break;
case 3:
{
vmoffset = sectLINKB;
size = sectSizeLINK;
}
break;
}
num_sects_txed++;
}
if (hoffset > max_header_size)
break;
sc = (struct segment_command *) (header);
sc->cmd = LC_SEGMENT;
sc->cmdsize = sizeof(struct segment_command);
sc->segname[0] = 0;
sc->vmaddr = vmoffset;
sc->vmsize = size;
sc->fileoff = foffset;
sc->filesize = size;
sc->maxprot = maxprot;
sc->initprot = prot;
sc->nsects = 0;
if ((panic_error = kdp_send_panic_pkt (KDP_SEEK, NULL, sizeof(hoffset) , &hoffset)) < 0) {
printf ("kdp_send_panic_pkt failed with error %d\n", panic_error);
return -1;
}
if ((panic_error = kdp_send_panic_packets (KDP_DATA, NULL, sizeof(struct segment_command) , (caddr_t) sc)) < 0) {
printf ("kdp_send_panic_packets failed with error %d\n", panic_error);
return -1 ;
}
if ((vbr.user_tag != VM_MEMORY_IOKIT)) {
if ((panic_error = kdp_send_panic_pkt (KDP_SEEK, NULL, sizeof(foffset) , &foffset)) < 0) {
printf ("kdp_send_panic_pkt failed with error %d\n", panic_error);
return (-1);
}
txstart = vmoffset;
if ((panic_error = kdp_send_panic_packets (KDP_DATA, NULL, size, (caddr_t) txstart)) < 0) {
printf ("kdp_send_panic_packets failed with error %d\n", panic_error);
return -1 ;
}
}
hoffset += sizeof(struct segment_command);
foffset += size;
vmoffset += size;
segment_count--;
}
tir1.header = header;
tir1.hoffset = 0;
tir1.flavors = flavors;
tir1.tstate_size = tstate_size;
kern_collectth_state (current_act(), &tir1);
if ((panic_error = kdp_send_panic_pkt (KDP_SEEK, NULL, sizeof(hoffset) , &hoffset)) < 0) {
printf ("kdp_send_panic_pkt failed with error %d\n", panic_error);
return -1;
}
if ((panic_error = kdp_send_panic_packets (KDP_DATA, NULL, tir1.hoffset , (caddr_t) header)) < 0) {
printf ("kdp_send_panic_packets failed with error %d\n", panic_error);
return -1 ;
}
if ((panic_error = kdp_send_panic_pkt (KDP_EOF, NULL, 0, ((void *) 0))) < 0)
{
printf ("kdp_send_panic_pkt failed with error %d\n", panic_error);
return (-1) ;
}
out:
if (error == 0)
error = error1;
return (error);
}