xnu-7195.101.1.tar.gz

[apple/xnu.git] / bsd / dev / i386 / sdt_x86.c

diff --git a/bsd/dev/i386/sdt_x86.c b/bsd/dev/i386/sdt_x86.c
index 680ed779b954ed5afc958538d489855833cd1b52..4b78fe79101ce618e7a0aea6ec28757159f05d69 100644 (file)
--- a/bsd/dev/i386/sdt_x86.c
+++ b/bsd/dev/i386/sdt_x86.c
@@ -23,15 +23,6 @@
  * Use is subject to license terms.
  */
 
  * Use is subject to license terms.
  */
 

-/* #pragma ident       "@(#)sdt.c      1.9     08/07/01 SMI" */
-
-#ifdef KERNEL
-#ifndef _KERNEL
-#define _KERNEL /* Solaris vs. Darwin */
-#endif
-#endif
-
-#define MACH__POSIX_C_SOURCE_PRIVATE 1 /* pulls in suitable savearea from mach/ppc/thread_status.h */

 #include <kern/cpu_data.h>
 #include <kern/thread.h>
 #include <mach/thread_status.h>
 #include <kern/cpu_data.h>
 #include <kern/thread.h>
 #include <mach/thread_status.h>


@@ -46,43 +37,6 @@
 
 extern sdt_probe_t      **sdt_probetab;
 
 
 extern sdt_probe_t      **sdt_probetab;
 

-#if defined(__i386__)
-/*ARGSUSED*/
-int
-sdt_invop(uintptr_t addr, uintptr_t *stack, uintptr_t eax)
-{
-#pragma unused(eax)
-       uintptr_t stack0 = 0, stack1 = 0, stack2 = 0, stack3 = 0, stack4 = 0;
-       sdt_probe_t *sdt = sdt_probetab[SDT_ADDR2NDX(addr)];
-
-       for (; sdt != NULL; sdt = sdt->sdp_hashnext) {
-               if ((uintptr_t)sdt->sdp_patchpoint == addr) {
-                        uintptr_t *stacktop;
-                        if (CPU_ON_INTR(CPU))
-                                stacktop = (uintptr_t *)dtrace_get_cpu_int_stack_top();
-                        else
-                                stacktop = (uintptr_t *)(dtrace_get_kernel_stack(current_thread()) + kernel_stack_size);
-
-            if (stack <= stacktop)
-                stack0 = *stack++;
-            if (stack <= stacktop)
-                stack1 = *stack++;
-            if (stack <= stacktop)
-                stack2 = *stack++;
-            if (stack <= stacktop)
-                stack3 = *stack++;
-            if (stack <= stacktop)
-                stack4 = *stack++;
-
-                       dtrace_probe(sdt->sdp_id, stack0, stack1, stack2, stack3, stack4);
-
-                       return (DTRACE_INVOP_NOP);
-               }
-       }
-
-       return (0);
-}
-#elif defined(__x86_64__)

 /*ARGSUSED*/
 int
 sdt_invop(uintptr_t addr, uintptr_t *stack, uintptr_t eax)
 /*ARGSUSED*/
 int
 sdt_invop(uintptr_t addr, uintptr_t *stack, uintptr_t eax)


@@ -96,60 +50,43 @@ sdt_invop(uintptr_t addr, uintptr_t *stack, uintptr_t eax)
 
                        dtrace_probe(sdt->sdp_id, regs->rdi, regs->rsi, regs->rdx, regs->rcx, regs->r8);
 
 
                        dtrace_probe(sdt->sdp_id, regs->rdi, regs->rsi, regs->rdx, regs->rcx, regs->r8);
 

-                       return (DTRACE_INVOP_NOP);
+                       return DTRACE_INVOP_NOP;

                }
        }
 
                }
        }
 

-       return (0);
+       return 0;

 }
 }

-#else
-#error Unknown arch
-#endif

 
 
 struct frame {
 
 
 struct frame {

-    struct frame *backchain;
-    uintptr_t retaddr;
+       struct frame *backchain;
+       uintptr_t retaddr;

 };
 
 /*ARGSUSED*/
 uint64_t
 sdt_getarg(void *arg, dtrace_id_t id, void *parg, int argno, int aframes)
 {
 };
 
 /*ARGSUSED*/
 uint64_t
 sdt_getarg(void *arg, dtrace_id_t id, void *parg, int argno, int aframes)
 {

-#pragma unused(arg, id, parg)    
+#pragma unused(arg, id, parg)

        uint64_t val;
        struct frame *fp = (struct frame *)__builtin_frame_address(0);
        uintptr_t *stack;
        uintptr_t pc;
        int i;
 
        uint64_t val;
        struct frame *fp = (struct frame *)__builtin_frame_address(0);
        uintptr_t *stack;
        uintptr_t pc;
        int i;
 

-#if defined(__x86_64__)
-    /*
-     * A total of 6 arguments are passed via registers; any argument with
-     * index of 5 or lower is therefore in a register.
-     */
-    int inreg = 5;
-#endif
+       /*
+        * A total of 6 arguments are passed via registers; any argument with
+        * index of 5 or lower is therefore in a register.
+        */
+       int inreg = 5;

 
        for (i = 1; i <= aframes; i++) {
                fp = fp->backchain;
                pc = fp->retaddr;
 
                if (dtrace_invop_callsite_pre != NULL
 
        for (i = 1; i <= aframes; i++) {
                fp = fp->backchain;
                pc = fp->retaddr;
 
                if (dtrace_invop_callsite_pre != NULL

-                       && pc  >  (uintptr_t)dtrace_invop_callsite_pre
-                       && pc  <= (uintptr_t)dtrace_invop_callsite_post) {
-#if defined(__i386__)
-                       /*
-                        * If we pass through the invalid op handler, we will
-                        * use the pointer that it passed to the stack as the
-                        * second argument to dtrace_invop() as the pointer to
-                        * the frame we're hunting for.
-                        */
-
-                       stack = (uintptr_t *)&fp[1]; /* Find marshalled arguments */
-                       fp = (struct frame *)stack[1]; /* Grab *second* argument */
-                       stack = (uintptr_t *)&fp[0]; /* Find marshalled arguments */
-#elif defined(__x86_64__)
+                   && pc > (uintptr_t)dtrace_invop_callsite_pre
+                   && pc <= (uintptr_t)dtrace_invop_callsite_post) {

                        /*
                         * In the case of x86_64, we will use the pointer to the
                         * save area structure that was pushed when we took the
                        /*
                         * In the case of x86_64, we will use the pointer to the
                         * save area structure that was pushed when we took the


@@ -167,21 +104,18 @@ sdt_getarg(void *arg, dtrace_id_t id, void *parg, int argno, int aframes)
                        fp = fp->backchain; /* to fbt_perfcallback() activation. */
                        fp = fp->backchain; /* to kernel_trap() activation. */
                        fp = fp->backchain; /* to trap_from_kernel() activation. */
                        fp = fp->backchain; /* to fbt_perfcallback() activation. */
                        fp = fp->backchain; /* to kernel_trap() activation. */
                        fp = fp->backchain; /* to trap_from_kernel() activation. */

-                       
+

                        x86_saved_state_t   *tagged_regs = (x86_saved_state_t *)&fp[1];
                        x86_saved_state64_t *saved_state = saved_state64(tagged_regs);
 
                        if (argno <= inreg) {
                        x86_saved_state_t   *tagged_regs = (x86_saved_state_t *)&fp[1];
                        x86_saved_state64_t *saved_state = saved_state64(tagged_regs);
 
                        if (argno <= inreg) {

-                               stack = (uintptr_t *)&saved_state->rdi;
+                               stack = (uintptr_t *)(void*)&saved_state->rdi;

                        } else {
                                fp = (struct frame *)(saved_state->isf.rsp);
                                stack = (uintptr_t *)&fp[0]; /* Find marshalled
                        } else {
                                fp = (struct frame *)(saved_state->isf.rsp);
                                stack = (uintptr_t *)&fp[0]; /* Find marshalled

-                                                               arguments */
-                               argno -= (inreg +1);
+                                                             *  arguments */
+                               argno -= (inreg + 1);

                        }
                        }

-#else
-#error Unknown arch
-#endif

                        goto load;
                }
        }
                        goto load;
                }
        }


@@ -195,7 +129,6 @@ sdt_getarg(void *arg, dtrace_id_t id, void *parg, int argno, int aframes)
         */
        argno++; /* Advance past probeID */
 
         */
        argno++; /* Advance past probeID */
 

-#if defined(__x86_64__)

        if (argno <= inreg) {
                /*
                 * This shouldn't happen.  If the argument is passed in a
        if (argno <= inreg) {
                /*
                 * This shouldn't happen.  If the argument is passed in a


@@ -203,11 +136,10 @@ sdt_getarg(void *arg, dtrace_id_t id, void *parg, int argno, int aframes)
                 * register...
                 */
                DTRACE_CPUFLAG_SET(CPU_DTRACE_ILLOP);
                 * register...
                 */
                DTRACE_CPUFLAG_SET(CPU_DTRACE_ILLOP);

-               return (0);
+               return 0;

        }
 
        argno -= (inreg + 1);
        }
 
        argno -= (inreg + 1);

-#endif

        stack = (uintptr_t *)&fp[1]; /* Find marshalled arguments */
 
 load:
        stack = (uintptr_t *)&fp[1]; /* Find marshalled arguments */
 
 load:


@@ -216,6 +148,5 @@ load:
        val = (uint64_t)(*(((uintptr_t *)stack) + argno));
        DTRACE_CPUFLAG_CLEAR(CPU_DTRACE_NOFAULT);
 
        val = (uint64_t)(*(((uintptr_t *)stack) + argno));
        DTRACE_CPUFLAG_CLEAR(CPU_DTRACE_NOFAULT);
 

-       return (val);
+       return val;

 }
 }

-