-#define LR_OFFSET 8
-#define LR_OFFSET64 16
-
-int
-machine_trace_thread(thread_t thread, uint32_t tracepos, uint32_t tracebound, int nframes, boolean_t user_p)
-{
- uint32_t *tracebuf = (uint32_t *)tracepos;
- uint32_t fence = 0;
- uint32_t stackptr = 0;
- uint32_t stacklimit = 0xb0000000;
- int framecount = 0;
- uint32_t init_srr0 = 0;
- uint32_t prevsp = 0;
- uint32_t framesize = 2 * sizeof(vm_offset_t);
-
- if (user_p) {
- /* Examine the user savearea */
- init_srr0 = thread->machine.upcb->save_srr0;
- stackptr = thread->machine.upcb->save_r1;
- /* This bound isn't useful, but it doesn't hinder us */
- stacklimit = 0xffffffff;
- kdp_pmap = thread->task->map->pmap;
- }
- else {
- stackptr = thread->machine.pcb->save_r1;
- init_srr0 = thread->machine.pcb->save_srr0;
- }
- /* Fill in the "current" program counter */
- *tracebuf++ = init_srr0;
-
- for (framecount = 0; framecount < nframes; framecount++) {
-/* Bounds check */
- if ((tracebound - ((uint32_t) tracebuf)) < (4 * framesize)) {
- tracebuf--;
- break;
- }
-
- *tracebuf++ = stackptr;
-/* Invalid frame, or hit fence */
- if (!stackptr || (stackptr == fence)) {
- break;
- }
-/* Stack grows downward */
- if (stackptr < prevsp) {
- break;
- }
-/* Unaligned frame */
- if (stackptr & 0x000000F) {
- break;
- }
- if (stackptr > stacklimit) {
- break;
- }
-/* Assume there's a saved link register, and read it */
- if (kdp_vm_read((caddr_t) (stackptr + LR_OFFSET), (caddr_t) tracebuf, sizeof(caddr_t)) != sizeof(caddr_t)) {
- break;
- }
-
- tracebuf++;
- prevsp = stackptr;
-/* Next frame */
- if (kdp_vm_read((caddr_t) stackptr, (caddr_t) &stackptr, sizeof(caddr_t)) != sizeof(caddr_t)) {
- *tracebuf++ = 0;
- break;
- }
- }
-/* Reset the target pmap */
- kdp_pmap = 0;
- return ((uint32_t) tracebuf - tracepos);
-}
-
-/* Routine to encapsulate the 64-bit address read hack*/
-unsigned
-machine_read64(addr64_t srcaddr, caddr_t dstaddr, uint32_t len)
-{
- uint32_t kdp_vm_read_low32;
- unsigned retval;
-
- kdp_src_high32 = srcaddr >> 32;
- kdp_vm_read_low32 = srcaddr & 0x00000000FFFFFFFFUL;
- retval = kdp_vm_read((caddr_t)kdp_vm_read_low32, dstaddr, len);
- kdp_src_high32 = 0;
- return retval;
-}
-
-int
-machine_trace_thread64(thread_t thread, uint32_t tracepos, uint32_t tracebound, int nframes, boolean_t user_p)
-{
- uint64_t *tracebuf = (uint64_t *)tracepos;
- uint32_t fence = 0;
- addr64_t stackptr = 0;
- uint64_t stacklimit = 0xb0000000;
- int framecount = 0;
- addr64_t init_srr0 = 0;
- addr64_t prevsp = 0;
- unsigned framesize = 2 * sizeof(addr64_t);
-
- if (user_p) {
- init_srr0 = thread->machine.upcb->save_srr0;
- stackptr = thread->machine.upcb->save_r1;
- stacklimit = 0xffffffffffffffffULL;
- kdp_pmap = thread->task->map->pmap;
- }
- else {
- stackptr = thread->machine.pcb->save_r1;
- init_srr0 = thread->machine.pcb->save_srr0;
- }
-
- *tracebuf++ = init_srr0;
-
- for (framecount = 0; framecount < nframes; framecount++) {
-
- if ((tracebound - ((uint32_t) tracebuf)) < (4 * framesize)) {
- tracebuf--;
- break;
- }
-
- *tracebuf++ = stackptr;
-
- if (!stackptr || (stackptr == fence)){
- break;
- }
- if (stackptr < prevsp) {
- break;
- }
- if (stackptr & 0x000000F) {
- break;
- }
- if (stackptr > stacklimit) {
- break;
- }
-
- if (machine_read64(stackptr+LR_OFFSET64, (caddr_t) tracebuf, sizeof(addr64_t)) != sizeof(addr64_t)) {
- break;
- }
- tracebuf++;
-
- prevsp = stackptr;
- if (machine_read64(stackptr, (caddr_t) &stackptr, sizeof(addr64_t)) != sizeof(addr64_t)) {
- *tracebuf++ = 0;
- break;
- }
- }
-
- kdp_pmap = 0;
-
- return ((uint32_t) tracebuf - tracepos);
-}