bsd/dev/i386/sdt_x86.c

   1 /*
   2  * CDDL HEADER START
   3  *
   4  * The contents of this file are subject to the terms of the
   5  * Common Development and Distribution License (the "License").
   6  * You may not use this file except in compliance with the License.
   7  *
   8  * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
   9  * or http://www.opensolaris.org/os/licensing.
  10  * See the License for the specific language governing permissions
  11  * and limitations under the License.
  12  *
  13  * When distributing Covered Code, include this CDDL HEADER in each
  14  * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
  15  * If applicable, add the following below this CDDL HEADER, with the
  16  * fields enclosed by brackets "[]" replaced with your own identifying
  17  * information: Portions Copyright [yyyy] [name of copyright owner]
  18  *
  19  * CDDL HEADER END
  20  */
  21 /*
  22  * Copyright 2006 Sun Microsystems, Inc.  All rights reserved.
  23  * Use is subject to license terms.
  24  */
  25
  26 /* #pragma ident        "@(#)sdt.c      1.6     06/03/24 SMI" */
  27
  28 #ifdef KERNEL
  29 #ifndef _KERNEL
  30 #define _KERNEL /* Solaris vs. Darwin */
  31 #endif
  32 #endif
  33
  34 #define MACH__POSIX_C_SOURCE_PRIVATE 1 /* pulls in suitable savearea from mach/ppc/thread_status.h */
  35 #include <kern/cpu_data.h>
  36 #include <kern/thread.h>
  37 #include <mach/thread_status.h>
  38 #include <mach/vm_param.h>
  39
  40 #include <sys/dtrace.h>
  41 #include <sys/dtrace_impl.h>
  42
  43 #include <sys/dtrace_glue.h>
  44
  45 #include <sys/sdt_impl.h>
  46
  47 extern sdt_probe_t      **sdt_probetab;
  48
  49 /*ARGSUSED*/
  50 int
  51 sdt_invop(uintptr_t addr, uintptr_t *stack, uintptr_t eax)
  52 {
  53 #pragma unused(eax)
  54         uintptr_t stack0 = 0, stack1 = 0, stack2 = 0, stack3 = 0, stack4 = 0;
  55         sdt_probe_t *sdt = sdt_probetab[SDT_ADDR2NDX(addr)];
  56
  57         for (; sdt != NULL; sdt = sdt->sdp_hashnext) {
  58                 if ((uintptr_t)sdt->sdp_patchpoint == addr) {
  59                         uintptr_t *stacktop;
  60                         if (CPU_ON_INTR(CPU))
  61                                 stacktop = (uintptr_t *)dtrace_get_cpu_int_stack_top();
  62                         else
  63                                 stacktop = (uintptr_t *)(dtrace_get_kernel_stack(current_thread()) + KERNEL_STACK_SIZE);
  64
  65             if (stack <= stacktop)
  66                 stack0 = *stack++;
  67             if (stack <= stacktop)
  68                 stack1 = *stack++;
  69             if (stack <= stacktop)
  70                 stack2 = *stack++;
  71             if (stack <= stacktop)
  72                 stack3 = *stack++;
  73             if (stack <= stacktop)
  74                 stack4 = *stack++;
  75
  76                         dtrace_probe(sdt->sdp_id, stack0, stack1, stack2, stack3, stack4);
  77
  78                         return (DTRACE_INVOP_NOP);
  79                 }
  80         }
  81
  82         return (0);
  83 }
  84