xref: /xnu-10002.61.3/bsd/dev/dtrace/dtrace_glue.c (revision 0f4c859e951fba394238ab619495c4e1d54d0f34)
1*0f4c859eSApple OSS Distributions /*
2*0f4c859eSApple OSS Distributions  * Copyright (c) 2005-2021 Apple Computer, Inc. All rights reserved.
3*0f4c859eSApple OSS Distributions  *
4*0f4c859eSApple OSS Distributions  * @APPLE_OSREFERENCE_LICENSE_HEADER_START@
5*0f4c859eSApple OSS Distributions  *
6*0f4c859eSApple OSS Distributions  * This file contains Original Code and/or Modifications of Original Code
7*0f4c859eSApple OSS Distributions  * as defined in and that are subject to the Apple Public Source License
8*0f4c859eSApple OSS Distributions  * Version 2.0 (the 'License'). You may not use this file except in
9*0f4c859eSApple OSS Distributions  * compliance with the License. The rights granted to you under the License
10*0f4c859eSApple OSS Distributions  * may not be used to create, or enable the creation or redistribution of,
11*0f4c859eSApple OSS Distributions  * unlawful or unlicensed copies of an Apple operating system, or to
12*0f4c859eSApple OSS Distributions  * circumvent, violate, or enable the circumvention or violation of, any
13*0f4c859eSApple OSS Distributions  * terms of an Apple operating system software license agreement.
14*0f4c859eSApple OSS Distributions  *
15*0f4c859eSApple OSS Distributions  * Please obtain a copy of the License at
16*0f4c859eSApple OSS Distributions  * http://www.opensource.apple.com/apsl/ and read it before using this file.
17*0f4c859eSApple OSS Distributions  *
18*0f4c859eSApple OSS Distributions  * The Original Code and all software distributed under the License are
19*0f4c859eSApple OSS Distributions  * distributed on an 'AS IS' basis, WITHOUT WARRANTY OF ANY KIND, EITHER
20*0f4c859eSApple OSS Distributions  * EXPRESS OR IMPLIED, AND APPLE HEREBY DISCLAIMS ALL SUCH WARRANTIES,
21*0f4c859eSApple OSS Distributions  * INCLUDING WITHOUT LIMITATION, ANY WARRANTIES OF MERCHANTABILITY,
22*0f4c859eSApple OSS Distributions  * FITNESS FOR A PARTICULAR PURPOSE, QUIET ENJOYMENT OR NON-INFRINGEMENT.
23*0f4c859eSApple OSS Distributions  * Please see the License for the specific language governing rights and
24*0f4c859eSApple OSS Distributions  * limitations under the License.
25*0f4c859eSApple OSS Distributions  *
26*0f4c859eSApple OSS Distributions  * @APPLE_OSREFERENCE_LICENSE_HEADER_END@
27*0f4c859eSApple OSS Distributions  */
28*0f4c859eSApple OSS Distributions 
29*0f4c859eSApple OSS Distributions #include <kern/thread.h>
30*0f4c859eSApple OSS Distributions 
31*0f4c859eSApple OSS Distributions #include <sys/time.h>
32*0f4c859eSApple OSS Distributions #include <sys/proc.h>
33*0f4c859eSApple OSS Distributions #include <sys/kauth.h>
34*0f4c859eSApple OSS Distributions #include <sys/user.h>
35*0f4c859eSApple OSS Distributions #include <sys/systm.h>
36*0f4c859eSApple OSS Distributions #include <sys/dtrace.h>
37*0f4c859eSApple OSS Distributions #include <sys/dtrace_impl.h>
38*0f4c859eSApple OSS Distributions #include <machine/atomic.h>
39*0f4c859eSApple OSS Distributions #include <libkern/OSKextLibPrivate.h>
40*0f4c859eSApple OSS Distributions #include <kern/kern_types.h>
41*0f4c859eSApple OSS Distributions #include <kern/timer_call.h>
42*0f4c859eSApple OSS Distributions #include <kern/thread_call.h>
43*0f4c859eSApple OSS Distributions #include <kern/task.h>
44*0f4c859eSApple OSS Distributions #include <kern/sched_prim.h>
45*0f4c859eSApple OSS Distributions #include <miscfs/devfs/devfs.h>
46*0f4c859eSApple OSS Distributions #include <kern/kalloc.h>
47*0f4c859eSApple OSS Distributions 
48*0f4c859eSApple OSS Distributions #include <mach/vm_param.h>
49*0f4c859eSApple OSS Distributions #include <mach/mach_vm.h>
50*0f4c859eSApple OSS Distributions #include <mach/task.h>
51*0f4c859eSApple OSS Distributions #include <vm/vm_map.h> /* All the bits we care about are guarded by MACH_KERNEL_PRIVATE :-( */
52*0f4c859eSApple OSS Distributions 
53*0f4c859eSApple OSS Distributions /*
54*0f4c859eSApple OSS Distributions  * pid/proc
55*0f4c859eSApple OSS Distributions  */
56*0f4c859eSApple OSS Distributions /* Solaris proc_t is the struct. Darwin's proc_t is a pointer to it. */
57*0f4c859eSApple OSS Distributions #define proc_t struct proc /* Steer clear of the Darwin typedef for proc_t */
58*0f4c859eSApple OSS Distributions 
59*0f4c859eSApple OSS Distributions KALLOC_HEAP_DEFINE(KHEAP_DTRACE, "dtrace", KHEAP_ID_KT_VAR);
60*0f4c859eSApple OSS Distributions 
61*0f4c859eSApple OSS Distributions void
dtrace_sprlock(proc_t * p)62*0f4c859eSApple OSS Distributions dtrace_sprlock(proc_t *p)
63*0f4c859eSApple OSS Distributions {
64*0f4c859eSApple OSS Distributions 	lck_mtx_lock(&p->p_dtrace_sprlock);
65*0f4c859eSApple OSS Distributions }
66*0f4c859eSApple OSS Distributions 
67*0f4c859eSApple OSS Distributions void
dtrace_sprunlock(proc_t * p)68*0f4c859eSApple OSS Distributions dtrace_sprunlock(proc_t *p)
69*0f4c859eSApple OSS Distributions {
70*0f4c859eSApple OSS Distributions 	lck_mtx_unlock(&p->p_dtrace_sprlock);
71*0f4c859eSApple OSS Distributions }
72*0f4c859eSApple OSS Distributions 
73*0f4c859eSApple OSS Distributions /* Not called from probe context */
74*0f4c859eSApple OSS Distributions proc_t *
sprlock(pid_t pid)75*0f4c859eSApple OSS Distributions sprlock(pid_t pid)
76*0f4c859eSApple OSS Distributions {
77*0f4c859eSApple OSS Distributions 	proc_t* p;
78*0f4c859eSApple OSS Distributions 
79*0f4c859eSApple OSS Distributions 	if ((p = proc_find(pid)) == PROC_NULL) {
80*0f4c859eSApple OSS Distributions 		return PROC_NULL;
81*0f4c859eSApple OSS Distributions 	}
82*0f4c859eSApple OSS Distributions 
83*0f4c859eSApple OSS Distributions 	task_suspend_internal(proc_task(p));
84*0f4c859eSApple OSS Distributions 
85*0f4c859eSApple OSS Distributions 	dtrace_sprlock(p);
86*0f4c859eSApple OSS Distributions 
87*0f4c859eSApple OSS Distributions 	return p;
88*0f4c859eSApple OSS Distributions }
89*0f4c859eSApple OSS Distributions 
90*0f4c859eSApple OSS Distributions /* Not called from probe context */
91*0f4c859eSApple OSS Distributions void
sprunlock(proc_t * p)92*0f4c859eSApple OSS Distributions sprunlock(proc_t *p)
93*0f4c859eSApple OSS Distributions {
94*0f4c859eSApple OSS Distributions 	if (p != PROC_NULL) {
95*0f4c859eSApple OSS Distributions 		dtrace_sprunlock(p);
96*0f4c859eSApple OSS Distributions 
97*0f4c859eSApple OSS Distributions 		task_resume_internal(proc_task(p));
98*0f4c859eSApple OSS Distributions 
99*0f4c859eSApple OSS Distributions 		proc_rele(p);
100*0f4c859eSApple OSS Distributions 	}
101*0f4c859eSApple OSS Distributions }
102*0f4c859eSApple OSS Distributions 
103*0f4c859eSApple OSS Distributions /*
104*0f4c859eSApple OSS Distributions  * uread/uwrite
105*0f4c859eSApple OSS Distributions  */
106*0f4c859eSApple OSS Distributions 
107*0f4c859eSApple OSS Distributions // These are not exported from vm_map.h.
108*0f4c859eSApple OSS Distributions extern kern_return_t vm_map_read_user(vm_map_t map, vm_map_address_t src_addr, void *dst_p, vm_size_t size);
109*0f4c859eSApple OSS Distributions extern kern_return_t vm_map_write_user(vm_map_t map, void *src_p, vm_map_address_t dst_addr, vm_size_t size);
110*0f4c859eSApple OSS Distributions 
111*0f4c859eSApple OSS Distributions /* Not called from probe context */
112*0f4c859eSApple OSS Distributions int
uread(proc_t * p,void * buf,user_size_t len,user_addr_t a)113*0f4c859eSApple OSS Distributions uread(proc_t *p, void *buf, user_size_t len, user_addr_t a)
114*0f4c859eSApple OSS Distributions {
115*0f4c859eSApple OSS Distributions 	kern_return_t ret;
116*0f4c859eSApple OSS Distributions 
117*0f4c859eSApple OSS Distributions 	ASSERT(p != PROC_NULL);
118*0f4c859eSApple OSS Distributions 	ASSERT(proc_task(p) != NULL);
119*0f4c859eSApple OSS Distributions 
120*0f4c859eSApple OSS Distributions 	task_t task = proc_task(p);
121*0f4c859eSApple OSS Distributions 
122*0f4c859eSApple OSS Distributions 	/*
123*0f4c859eSApple OSS Distributions 	 * Grab a reference to the task vm_map_t to make sure
124*0f4c859eSApple OSS Distributions 	 * the map isn't pulled out from under us.
125*0f4c859eSApple OSS Distributions 	 *
126*0f4c859eSApple OSS Distributions 	 * Because the proc_lock is not held at all times on all code
127*0f4c859eSApple OSS Distributions 	 * paths leading here, it is possible for the proc to have
128*0f4c859eSApple OSS Distributions 	 * exited. If the map is null, fail.
129*0f4c859eSApple OSS Distributions 	 */
130*0f4c859eSApple OSS Distributions 	vm_map_t map = get_task_map_reference(task);
131*0f4c859eSApple OSS Distributions 	if (map) {
132*0f4c859eSApple OSS Distributions 		ret = vm_map_read_user( map, (vm_map_address_t)a, buf, (vm_size_t)len);
133*0f4c859eSApple OSS Distributions 		vm_map_deallocate(map);
134*0f4c859eSApple OSS Distributions 	} else {
135*0f4c859eSApple OSS Distributions 		ret = KERN_TERMINATED;
136*0f4c859eSApple OSS Distributions 	}
137*0f4c859eSApple OSS Distributions 
138*0f4c859eSApple OSS Distributions 	return (int)ret;
139*0f4c859eSApple OSS Distributions }
140*0f4c859eSApple OSS Distributions 
141*0f4c859eSApple OSS Distributions 
142*0f4c859eSApple OSS Distributions /* Not called from probe context */
143*0f4c859eSApple OSS Distributions int
uwrite(proc_t * p,void * buf,user_size_t len,user_addr_t a)144*0f4c859eSApple OSS Distributions uwrite(proc_t *p, void *buf, user_size_t len, user_addr_t a)
145*0f4c859eSApple OSS Distributions {
146*0f4c859eSApple OSS Distributions 	kern_return_t ret;
147*0f4c859eSApple OSS Distributions 
148*0f4c859eSApple OSS Distributions 	ASSERT(p != NULL);
149*0f4c859eSApple OSS Distributions 	ASSERT(proc_task(p) != NULL);
150*0f4c859eSApple OSS Distributions 
151*0f4c859eSApple OSS Distributions 	task_t task = proc_task(p);
152*0f4c859eSApple OSS Distributions 
153*0f4c859eSApple OSS Distributions 	/*
154*0f4c859eSApple OSS Distributions 	 * Grab a reference to the task vm_map_t to make sure
155*0f4c859eSApple OSS Distributions 	 * the map isn't pulled out from under us.
156*0f4c859eSApple OSS Distributions 	 *
157*0f4c859eSApple OSS Distributions 	 * Because the proc_lock is not held at all times on all code
158*0f4c859eSApple OSS Distributions 	 * paths leading here, it is possible for the proc to have
159*0f4c859eSApple OSS Distributions 	 * exited. If the map is null, fail.
160*0f4c859eSApple OSS Distributions 	 */
161*0f4c859eSApple OSS Distributions 	vm_map_t map = get_task_map_reference(task);
162*0f4c859eSApple OSS Distributions 	if (map) {
163*0f4c859eSApple OSS Distributions 		/* Find the memory permissions. */
164*0f4c859eSApple OSS Distributions 		uint32_t nestingDepth = 999999;
165*0f4c859eSApple OSS Distributions 		vm_region_submap_short_info_data_64_t info;
166*0f4c859eSApple OSS Distributions 		mach_msg_type_number_t count = VM_REGION_SUBMAP_SHORT_INFO_COUNT_64;
167*0f4c859eSApple OSS Distributions 		mach_vm_address_t address = (mach_vm_address_t)a;
168*0f4c859eSApple OSS Distributions 		mach_vm_size_t sizeOfRegion = (mach_vm_size_t)len;
169*0f4c859eSApple OSS Distributions 
170*0f4c859eSApple OSS Distributions 		ret = mach_vm_region_recurse(map, &address, &sizeOfRegion, &nestingDepth, (vm_region_recurse_info_t)&info, &count);
171*0f4c859eSApple OSS Distributions 		if (ret != KERN_SUCCESS) {
172*0f4c859eSApple OSS Distributions 			goto done;
173*0f4c859eSApple OSS Distributions 		}
174*0f4c859eSApple OSS Distributions 
175*0f4c859eSApple OSS Distributions 		vm_prot_t reprotect;
176*0f4c859eSApple OSS Distributions 
177*0f4c859eSApple OSS Distributions 		if (!(info.protection & VM_PROT_WRITE)) {
178*0f4c859eSApple OSS Distributions 			/* Save the original protection values for restoration later */
179*0f4c859eSApple OSS Distributions 			reprotect = info.protection;
180*0f4c859eSApple OSS Distributions 
181*0f4c859eSApple OSS Distributions 			if (info.max_protection & VM_PROT_WRITE) {
182*0f4c859eSApple OSS Distributions 				/* The memory is not currently writable, but can be made writable. */
183*0f4c859eSApple OSS Distributions 				ret = mach_vm_protect(map, (mach_vm_offset_t)a, (mach_vm_size_t)len, 0, (reprotect & ~VM_PROT_EXECUTE) | VM_PROT_WRITE);
184*0f4c859eSApple OSS Distributions 			} else {
185*0f4c859eSApple OSS Distributions 				/*
186*0f4c859eSApple OSS Distributions 				 * The memory is not currently writable, and cannot be made writable. We need to COW this memory.
187*0f4c859eSApple OSS Distributions 				 *
188*0f4c859eSApple OSS Distributions 				 * Strange, we can't just say "reprotect | VM_PROT_COPY", that fails.
189*0f4c859eSApple OSS Distributions 				 */
190*0f4c859eSApple OSS Distributions 				ret = mach_vm_protect(map, (mach_vm_offset_t)a, (mach_vm_size_t)len, 0, VM_PROT_COPY | VM_PROT_READ | VM_PROT_WRITE);
191*0f4c859eSApple OSS Distributions 			}
192*0f4c859eSApple OSS Distributions 
193*0f4c859eSApple OSS Distributions 			if (ret != KERN_SUCCESS) {
194*0f4c859eSApple OSS Distributions 				goto done;
195*0f4c859eSApple OSS Distributions 			}
196*0f4c859eSApple OSS Distributions 		} else {
197*0f4c859eSApple OSS Distributions 			/* The memory was already writable. */
198*0f4c859eSApple OSS Distributions 			reprotect = VM_PROT_NONE;
199*0f4c859eSApple OSS Distributions 		}
200*0f4c859eSApple OSS Distributions 
201*0f4c859eSApple OSS Distributions 		ret = vm_map_write_user( map,
202*0f4c859eSApple OSS Distributions 		    buf,
203*0f4c859eSApple OSS Distributions 		    (vm_map_address_t)a,
204*0f4c859eSApple OSS Distributions 		    (vm_size_t)len);
205*0f4c859eSApple OSS Distributions 
206*0f4c859eSApple OSS Distributions 		dtrace_flush_caches();
207*0f4c859eSApple OSS Distributions 
208*0f4c859eSApple OSS Distributions 		if (ret != KERN_SUCCESS) {
209*0f4c859eSApple OSS Distributions 			goto done;
210*0f4c859eSApple OSS Distributions 		}
211*0f4c859eSApple OSS Distributions 
212*0f4c859eSApple OSS Distributions 		if (reprotect != VM_PROT_NONE) {
213*0f4c859eSApple OSS Distributions 			ASSERT(reprotect & VM_PROT_EXECUTE);
214*0f4c859eSApple OSS Distributions 			ret = mach_vm_protect(map, (mach_vm_offset_t)a, (mach_vm_size_t)len, 0, reprotect);
215*0f4c859eSApple OSS Distributions 		}
216*0f4c859eSApple OSS Distributions 
217*0f4c859eSApple OSS Distributions done:
218*0f4c859eSApple OSS Distributions 		vm_map_deallocate(map);
219*0f4c859eSApple OSS Distributions 	} else {
220*0f4c859eSApple OSS Distributions 		ret = KERN_TERMINATED;
221*0f4c859eSApple OSS Distributions 	}
222*0f4c859eSApple OSS Distributions 
223*0f4c859eSApple OSS Distributions 	return (int)ret;
224*0f4c859eSApple OSS Distributions }
225*0f4c859eSApple OSS Distributions 
226*0f4c859eSApple OSS Distributions /*
227*0f4c859eSApple OSS Distributions  * cpuvar
228*0f4c859eSApple OSS Distributions  */
229*0f4c859eSApple OSS Distributions LCK_MTX_DECLARE_ATTR(cpu_lock, &dtrace_lck_grp, &dtrace_lck_attr);
230*0f4c859eSApple OSS Distributions LCK_MTX_DECLARE_ATTR(cyc_lock, &dtrace_lck_grp, &dtrace_lck_attr);
231*0f4c859eSApple OSS Distributions LCK_MTX_DECLARE_ATTR(mod_lock, &dtrace_lck_grp, &dtrace_lck_attr);
232*0f4c859eSApple OSS Distributions 
233*0f4c859eSApple OSS Distributions dtrace_cpu_t *cpu_list;
234*0f4c859eSApple OSS Distributions cpu_core_t *cpu_core; /* XXX TLB lockdown? */
235*0f4c859eSApple OSS Distributions 
236*0f4c859eSApple OSS Distributions /*
237*0f4c859eSApple OSS Distributions  * cred_t
238*0f4c859eSApple OSS Distributions  */
239*0f4c859eSApple OSS Distributions 
240*0f4c859eSApple OSS Distributions /*
241*0f4c859eSApple OSS Distributions  * dtrace_CRED() can be called from probe context. We cannot simply call kauth_cred_get() since
242*0f4c859eSApple OSS Distributions  * that function may try to resolve a lazy credential binding, which entails taking the proc_lock.
243*0f4c859eSApple OSS Distributions  */
244*0f4c859eSApple OSS Distributions cred_t *
dtrace_CRED(void)245*0f4c859eSApple OSS Distributions dtrace_CRED(void)
246*0f4c859eSApple OSS Distributions {
247*0f4c859eSApple OSS Distributions 	return current_thread_ro_unchecked()->tro_cred;
248*0f4c859eSApple OSS Distributions }
249*0f4c859eSApple OSS Distributions 
250*0f4c859eSApple OSS Distributions int
PRIV_POLICY_CHOICE(void * cred,int priv,int all)251*0f4c859eSApple OSS Distributions PRIV_POLICY_CHOICE(void* cred, int priv, int all)
252*0f4c859eSApple OSS Distributions {
253*0f4c859eSApple OSS Distributions #pragma unused(priv, all)
254*0f4c859eSApple OSS Distributions 	return kauth_cred_issuser(cred); /* XXX TODO: How is this different from PRIV_POLICY_ONLY? */
255*0f4c859eSApple OSS Distributions }
256*0f4c859eSApple OSS Distributions 
257*0f4c859eSApple OSS Distributions int
PRIV_POLICY_ONLY(void * cr,int priv,int boolean)258*0f4c859eSApple OSS Distributions PRIV_POLICY_ONLY(void *cr, int priv, int boolean)
259*0f4c859eSApple OSS Distributions {
260*0f4c859eSApple OSS Distributions #pragma unused(priv, boolean)
261*0f4c859eSApple OSS Distributions 	return kauth_cred_issuser(cr); /* XXX TODO: HAS_PRIVILEGE(cr, priv); */
262*0f4c859eSApple OSS Distributions }
263*0f4c859eSApple OSS Distributions 
264*0f4c859eSApple OSS Distributions uid_t
crgetuid(const cred_t * cr)265*0f4c859eSApple OSS Distributions crgetuid(const cred_t *cr)
266*0f4c859eSApple OSS Distributions {
267*0f4c859eSApple OSS Distributions 	cred_t copy_cr = *cr; return kauth_cred_getuid(&copy_cr);
268*0f4c859eSApple OSS Distributions }
269*0f4c859eSApple OSS Distributions 
270*0f4c859eSApple OSS Distributions /*
271*0f4c859eSApple OSS Distributions  * "cyclic"
272*0f4c859eSApple OSS Distributions  */
273*0f4c859eSApple OSS Distributions 
274*0f4c859eSApple OSS Distributions typedef struct wrap_timer_call {
275*0f4c859eSApple OSS Distributions 	/* node attributes */
276*0f4c859eSApple OSS Distributions 	cyc_handler_t           hdlr;
277*0f4c859eSApple OSS Distributions 	cyc_time_t              when;
278*0f4c859eSApple OSS Distributions 	uint64_t                deadline;
279*0f4c859eSApple OSS Distributions 	int                     cpuid;
280*0f4c859eSApple OSS Distributions 	boolean_t               suspended;
281*0f4c859eSApple OSS Distributions 	struct timer_call       call;
282*0f4c859eSApple OSS Distributions 
283*0f4c859eSApple OSS Distributions 	/* next item in the linked list */
284*0f4c859eSApple OSS Distributions 	LIST_ENTRY(wrap_timer_call) entries;
285*0f4c859eSApple OSS Distributions } wrap_timer_call_t;
286*0f4c859eSApple OSS Distributions 
287*0f4c859eSApple OSS Distributions #define WAKEUP_REAPER           0x7FFFFFFFFFFFFFFFLL
288*0f4c859eSApple OSS Distributions #define NEARLY_FOREVER          0x7FFFFFFFFFFFFFFELL
289*0f4c859eSApple OSS Distributions 
290*0f4c859eSApple OSS Distributions 
291*0f4c859eSApple OSS Distributions typedef struct cyc_list {
292*0f4c859eSApple OSS Distributions 	cyc_omni_handler_t cyl_omni;
293*0f4c859eSApple OSS Distributions 	wrap_timer_call_t cyl_wrap_by_cpus[];
294*0f4c859eSApple OSS Distributions } cyc_list_t;
295*0f4c859eSApple OSS Distributions 
296*0f4c859eSApple OSS Distributions /* CPU going online/offline notifications */
297*0f4c859eSApple OSS Distributions void (*dtrace_cpu_state_changed_hook)(int, boolean_t) = NULL;
298*0f4c859eSApple OSS Distributions void dtrace_cpu_state_changed(int, boolean_t);
299*0f4c859eSApple OSS Distributions 
300*0f4c859eSApple OSS Distributions void
dtrace_install_cpu_hooks(void)301*0f4c859eSApple OSS Distributions dtrace_install_cpu_hooks(void)
302*0f4c859eSApple OSS Distributions {
303*0f4c859eSApple OSS Distributions 	dtrace_cpu_state_changed_hook = dtrace_cpu_state_changed;
304*0f4c859eSApple OSS Distributions }
305*0f4c859eSApple OSS Distributions 
306*0f4c859eSApple OSS Distributions void
dtrace_cpu_state_changed(int cpuid,boolean_t is_running)307*0f4c859eSApple OSS Distributions dtrace_cpu_state_changed(int cpuid, boolean_t is_running)
308*0f4c859eSApple OSS Distributions {
309*0f4c859eSApple OSS Distributions 	wrap_timer_call_t       *wrapTC = NULL;
310*0f4c859eSApple OSS Distributions 	boolean_t               suspend = (is_running ? FALSE : TRUE);
311*0f4c859eSApple OSS Distributions 	dtrace_icookie_t        s;
312*0f4c859eSApple OSS Distributions 
313*0f4c859eSApple OSS Distributions 	/* Ensure that we're not going to leave the CPU */
314*0f4c859eSApple OSS Distributions 	s = dtrace_interrupt_disable();
315*0f4c859eSApple OSS Distributions 
316*0f4c859eSApple OSS Distributions 	LIST_FOREACH(wrapTC, &(cpu_list[cpuid].cpu_cyc_list), entries) {
317*0f4c859eSApple OSS Distributions 		assert3u(wrapTC->cpuid, ==, cpuid);
318*0f4c859eSApple OSS Distributions 		if (suspend) {
319*0f4c859eSApple OSS Distributions 			assert(!wrapTC->suspended);
320*0f4c859eSApple OSS Distributions 			/* If this fails, we'll panic anyway, so let's do this now. */
321*0f4c859eSApple OSS Distributions 			if (!timer_call_cancel(&wrapTC->call)) {
322*0f4c859eSApple OSS Distributions 				panic("timer_call_cancel() failed to cancel a timer call: %p",
323*0f4c859eSApple OSS Distributions 				    &wrapTC->call);
324*0f4c859eSApple OSS Distributions 			}
325*0f4c859eSApple OSS Distributions 			wrapTC->suspended = TRUE;
326*0f4c859eSApple OSS Distributions 		} else {
327*0f4c859eSApple OSS Distributions 			/* Rearm the timer, but ensure it was suspended first. */
328*0f4c859eSApple OSS Distributions 			assert(wrapTC->suspended);
329*0f4c859eSApple OSS Distributions 			clock_deadline_for_periodic_event(wrapTC->when.cyt_interval, mach_absolute_time(),
330*0f4c859eSApple OSS Distributions 			    &wrapTC->deadline);
331*0f4c859eSApple OSS Distributions 			timer_call_enter1(&wrapTC->call, (void*) wrapTC, wrapTC->deadline,
332*0f4c859eSApple OSS Distributions 			    TIMER_CALL_SYS_CRITICAL | TIMER_CALL_LOCAL);
333*0f4c859eSApple OSS Distributions 			wrapTC->suspended = FALSE;
334*0f4c859eSApple OSS Distributions 		}
335*0f4c859eSApple OSS Distributions 	}
336*0f4c859eSApple OSS Distributions 
337*0f4c859eSApple OSS Distributions 	/* Restore the previous interrupt state. */
338*0f4c859eSApple OSS Distributions 	dtrace_interrupt_enable(s);
339*0f4c859eSApple OSS Distributions }
340*0f4c859eSApple OSS Distributions 
341*0f4c859eSApple OSS Distributions static void
_timer_call_apply_cyclic(void * ignore,void * vTChdl)342*0f4c859eSApple OSS Distributions _timer_call_apply_cyclic( void *ignore, void *vTChdl )
343*0f4c859eSApple OSS Distributions {
344*0f4c859eSApple OSS Distributions #pragma unused(ignore)
345*0f4c859eSApple OSS Distributions 	wrap_timer_call_t *wrapTC = (wrap_timer_call_t *)vTChdl;
346*0f4c859eSApple OSS Distributions 
347*0f4c859eSApple OSS Distributions 	(*(wrapTC->hdlr.cyh_func))( wrapTC->hdlr.cyh_arg );
348*0f4c859eSApple OSS Distributions 
349*0f4c859eSApple OSS Distributions 	clock_deadline_for_periodic_event( wrapTC->when.cyt_interval, mach_absolute_time(), &(wrapTC->deadline));
350*0f4c859eSApple OSS Distributions 	timer_call_enter1( &(wrapTC->call), (void *)wrapTC, wrapTC->deadline, TIMER_CALL_SYS_CRITICAL | TIMER_CALL_LOCAL );
351*0f4c859eSApple OSS Distributions }
352*0f4c859eSApple OSS Distributions 
353*0f4c859eSApple OSS Distributions static cyclic_id_t
timer_call_add_cyclic(wrap_timer_call_t * wrapTC,cyc_handler_t * handler,cyc_time_t * when)354*0f4c859eSApple OSS Distributions timer_call_add_cyclic(wrap_timer_call_t *wrapTC, cyc_handler_t *handler, cyc_time_t *when)
355*0f4c859eSApple OSS Distributions {
356*0f4c859eSApple OSS Distributions 	uint64_t now;
357*0f4c859eSApple OSS Distributions 	dtrace_icookie_t s;
358*0f4c859eSApple OSS Distributions 
359*0f4c859eSApple OSS Distributions 	timer_call_setup( &(wrapTC->call), _timer_call_apply_cyclic, NULL );
360*0f4c859eSApple OSS Distributions 	wrapTC->hdlr = *handler;
361*0f4c859eSApple OSS Distributions 	wrapTC->when = *when;
362*0f4c859eSApple OSS Distributions 
363*0f4c859eSApple OSS Distributions 	nanoseconds_to_absolutetime( wrapTC->when.cyt_interval, (uint64_t *)&wrapTC->when.cyt_interval );
364*0f4c859eSApple OSS Distributions 
365*0f4c859eSApple OSS Distributions 	now = mach_absolute_time();
366*0f4c859eSApple OSS Distributions 	wrapTC->deadline = now;
367*0f4c859eSApple OSS Distributions 
368*0f4c859eSApple OSS Distributions 	clock_deadline_for_periodic_event( wrapTC->when.cyt_interval, now, &(wrapTC->deadline));
369*0f4c859eSApple OSS Distributions 
370*0f4c859eSApple OSS Distributions 	/* Insert the timer to the list of the running timers on this CPU, and start it. */
371*0f4c859eSApple OSS Distributions 	s = dtrace_interrupt_disable();
372*0f4c859eSApple OSS Distributions 	wrapTC->cpuid = cpu_number();
373*0f4c859eSApple OSS Distributions 	LIST_INSERT_HEAD(&cpu_list[wrapTC->cpuid].cpu_cyc_list, wrapTC, entries);
374*0f4c859eSApple OSS Distributions 	timer_call_enter1(&wrapTC->call, (void*) wrapTC, wrapTC->deadline,
375*0f4c859eSApple OSS Distributions 	    TIMER_CALL_SYS_CRITICAL | TIMER_CALL_LOCAL);
376*0f4c859eSApple OSS Distributions 	wrapTC->suspended = FALSE;
377*0f4c859eSApple OSS Distributions 	dtrace_interrupt_enable(s);
378*0f4c859eSApple OSS Distributions 
379*0f4c859eSApple OSS Distributions 	return (cyclic_id_t)wrapTC;
380*0f4c859eSApple OSS Distributions }
381*0f4c859eSApple OSS Distributions 
382*0f4c859eSApple OSS Distributions /*
383*0f4c859eSApple OSS Distributions  * Executed on the CPU the timer is running on.
384*0f4c859eSApple OSS Distributions  */
385*0f4c859eSApple OSS Distributions static void
timer_call_remove_cyclic(wrap_timer_call_t * wrapTC)386*0f4c859eSApple OSS Distributions timer_call_remove_cyclic(wrap_timer_call_t *wrapTC)
387*0f4c859eSApple OSS Distributions {
388*0f4c859eSApple OSS Distributions 	assert(wrapTC);
389*0f4c859eSApple OSS Distributions 	assert(cpu_number() == wrapTC->cpuid);
390*0f4c859eSApple OSS Distributions 
391*0f4c859eSApple OSS Distributions 	if (!timer_call_cancel(&wrapTC->call)) {
392*0f4c859eSApple OSS Distributions 		panic("timer_call_remove_cyclic() failed to cancel a timer call");
393*0f4c859eSApple OSS Distributions 	}
394*0f4c859eSApple OSS Distributions 
395*0f4c859eSApple OSS Distributions 	LIST_REMOVE(wrapTC, entries);
396*0f4c859eSApple OSS Distributions }
397*0f4c859eSApple OSS Distributions 
398*0f4c859eSApple OSS Distributions static void *
timer_call_get_cyclic_arg(wrap_timer_call_t * wrapTC)399*0f4c859eSApple OSS Distributions timer_call_get_cyclic_arg(wrap_timer_call_t *wrapTC)
400*0f4c859eSApple OSS Distributions {
401*0f4c859eSApple OSS Distributions 	return wrapTC ? wrapTC->hdlr.cyh_arg : NULL;
402*0f4c859eSApple OSS Distributions }
403*0f4c859eSApple OSS Distributions 
404*0f4c859eSApple OSS Distributions cyclic_id_t
cyclic_timer_add(cyc_handler_t * handler,cyc_time_t * when)405*0f4c859eSApple OSS Distributions cyclic_timer_add(cyc_handler_t *handler, cyc_time_t *when)
406*0f4c859eSApple OSS Distributions {
407*0f4c859eSApple OSS Distributions 	wrap_timer_call_t *wrapTC = kalloc_type(wrap_timer_call_t, Z_ZERO | Z_WAITOK);
408*0f4c859eSApple OSS Distributions 	if (NULL == wrapTC) {
409*0f4c859eSApple OSS Distributions 		return CYCLIC_NONE;
410*0f4c859eSApple OSS Distributions 	} else {
411*0f4c859eSApple OSS Distributions 		return timer_call_add_cyclic( wrapTC, handler, when );
412*0f4c859eSApple OSS Distributions 	}
413*0f4c859eSApple OSS Distributions }
414*0f4c859eSApple OSS Distributions 
415*0f4c859eSApple OSS Distributions void
cyclic_timer_remove(cyclic_id_t cyclic)416*0f4c859eSApple OSS Distributions cyclic_timer_remove(cyclic_id_t cyclic)
417*0f4c859eSApple OSS Distributions {
418*0f4c859eSApple OSS Distributions 	ASSERT( cyclic != CYCLIC_NONE );
419*0f4c859eSApple OSS Distributions 
420*0f4c859eSApple OSS Distributions 	/* Removing a timer call must be done on the CPU the timer is running on. */
421*0f4c859eSApple OSS Distributions 	wrap_timer_call_t *wrapTC = (wrap_timer_call_t *) cyclic;
422*0f4c859eSApple OSS Distributions 	dtrace_xcall(wrapTC->cpuid, (dtrace_xcall_t) timer_call_remove_cyclic, (void*) cyclic);
423*0f4c859eSApple OSS Distributions 
424*0f4c859eSApple OSS Distributions 	kfree_type(wrap_timer_call_t, wrapTC);
425*0f4c859eSApple OSS Distributions }
426*0f4c859eSApple OSS Distributions 
427*0f4c859eSApple OSS Distributions static void
_cyclic_add_omni(cyc_list_t * cyc_list)428*0f4c859eSApple OSS Distributions _cyclic_add_omni(cyc_list_t *cyc_list)
429*0f4c859eSApple OSS Distributions {
430*0f4c859eSApple OSS Distributions 	cyc_time_t cT;
431*0f4c859eSApple OSS Distributions 	cyc_handler_t cH;
432*0f4c859eSApple OSS Distributions 	cyc_omni_handler_t *omni = &cyc_list->cyl_omni;
433*0f4c859eSApple OSS Distributions 
434*0f4c859eSApple OSS Distributions 	(omni->cyo_online)(omni->cyo_arg, CPU, &cH, &cT);
435*0f4c859eSApple OSS Distributions 
436*0f4c859eSApple OSS Distributions 	wrap_timer_call_t *wrapTC = &cyc_list->cyl_wrap_by_cpus[cpu_number()];
437*0f4c859eSApple OSS Distributions 	timer_call_add_cyclic(wrapTC, &cH, &cT);
438*0f4c859eSApple OSS Distributions }
439*0f4c859eSApple OSS Distributions 
440*0f4c859eSApple OSS Distributions cyclic_id_list_t
cyclic_add_omni(cyc_omni_handler_t * omni)441*0f4c859eSApple OSS Distributions cyclic_add_omni(cyc_omni_handler_t *omni)
442*0f4c859eSApple OSS Distributions {
443*0f4c859eSApple OSS Distributions 	cyc_list_t *cyc_list = kalloc_type(cyc_list_t, wrap_timer_call_t, NCPU, Z_WAITOK | Z_ZERO);
444*0f4c859eSApple OSS Distributions 
445*0f4c859eSApple OSS Distributions 	if (NULL == cyc_list) {
446*0f4c859eSApple OSS Distributions 		return NULL;
447*0f4c859eSApple OSS Distributions 	}
448*0f4c859eSApple OSS Distributions 
449*0f4c859eSApple OSS Distributions 	cyc_list->cyl_omni = *omni;
450*0f4c859eSApple OSS Distributions 
451*0f4c859eSApple OSS Distributions 	dtrace_xcall(DTRACE_CPUALL, (dtrace_xcall_t)_cyclic_add_omni, (void *)cyc_list);
452*0f4c859eSApple OSS Distributions 
453*0f4c859eSApple OSS Distributions 	return (cyclic_id_list_t)cyc_list;
454*0f4c859eSApple OSS Distributions }
455*0f4c859eSApple OSS Distributions 
456*0f4c859eSApple OSS Distributions static void
_cyclic_remove_omni(cyc_list_t * cyc_list)457*0f4c859eSApple OSS Distributions _cyclic_remove_omni(cyc_list_t *cyc_list)
458*0f4c859eSApple OSS Distributions {
459*0f4c859eSApple OSS Distributions 	cyc_omni_handler_t *omni = &cyc_list->cyl_omni;
460*0f4c859eSApple OSS Distributions 	void *oarg;
461*0f4c859eSApple OSS Distributions 	wrap_timer_call_t *wrapTC;
462*0f4c859eSApple OSS Distributions 
463*0f4c859eSApple OSS Distributions 	/*
464*0f4c859eSApple OSS Distributions 	 * If the processor was offline when dtrace started, we did not allocate
465*0f4c859eSApple OSS Distributions 	 * a cyclic timer for this CPU.
466*0f4c859eSApple OSS Distributions 	 */
467*0f4c859eSApple OSS Distributions 	if ((wrapTC = &cyc_list->cyl_wrap_by_cpus[cpu_number()]) != NULL) {
468*0f4c859eSApple OSS Distributions 		oarg = timer_call_get_cyclic_arg(wrapTC);
469*0f4c859eSApple OSS Distributions 		timer_call_remove_cyclic(wrapTC);
470*0f4c859eSApple OSS Distributions 		(omni->cyo_offline)(omni->cyo_arg, CPU, oarg);
471*0f4c859eSApple OSS Distributions 	}
472*0f4c859eSApple OSS Distributions }
473*0f4c859eSApple OSS Distributions 
474*0f4c859eSApple OSS Distributions void
cyclic_remove_omni(cyclic_id_list_t cyc_list)475*0f4c859eSApple OSS Distributions cyclic_remove_omni(cyclic_id_list_t cyc_list)
476*0f4c859eSApple OSS Distributions {
477*0f4c859eSApple OSS Distributions 	ASSERT(cyc_list != NULL);
478*0f4c859eSApple OSS Distributions 
479*0f4c859eSApple OSS Distributions 	dtrace_xcall(DTRACE_CPUALL, (dtrace_xcall_t)_cyclic_remove_omni, (void *)cyc_list);
480*0f4c859eSApple OSS Distributions 	void *cyc_list_p = (void *)cyc_list;
481*0f4c859eSApple OSS Distributions 	kfree_type(cyc_list_t, wrap_timer_call_t, NCPU, cyc_list_p);
482*0f4c859eSApple OSS Distributions }
483*0f4c859eSApple OSS Distributions 
484*0f4c859eSApple OSS Distributions typedef struct wrap_thread_call {
485*0f4c859eSApple OSS Distributions 	thread_call_t TChdl;
486*0f4c859eSApple OSS Distributions 	cyc_handler_t hdlr;
487*0f4c859eSApple OSS Distributions 	cyc_time_t when;
488*0f4c859eSApple OSS Distributions 	uint64_t deadline;
489*0f4c859eSApple OSS Distributions } wrap_thread_call_t;
490*0f4c859eSApple OSS Distributions 
491*0f4c859eSApple OSS Distributions /*
492*0f4c859eSApple OSS Distributions  * _cyclic_apply will run on some thread under kernel_task. That's OK for the
493*0f4c859eSApple OSS Distributions  * cleaner and the deadman, but too distant in time and place for the profile provider.
494*0f4c859eSApple OSS Distributions  */
495*0f4c859eSApple OSS Distributions static void
_cyclic_apply(void * ignore,void * vTChdl)496*0f4c859eSApple OSS Distributions _cyclic_apply( void *ignore, void *vTChdl )
497*0f4c859eSApple OSS Distributions {
498*0f4c859eSApple OSS Distributions #pragma unused(ignore)
499*0f4c859eSApple OSS Distributions 	wrap_thread_call_t *wrapTC = (wrap_thread_call_t *)vTChdl;
500*0f4c859eSApple OSS Distributions 
501*0f4c859eSApple OSS Distributions 	(*(wrapTC->hdlr.cyh_func))( wrapTC->hdlr.cyh_arg );
502*0f4c859eSApple OSS Distributions 
503*0f4c859eSApple OSS Distributions 	clock_deadline_for_periodic_event( wrapTC->when.cyt_interval, mach_absolute_time(), &(wrapTC->deadline));
504*0f4c859eSApple OSS Distributions 	(void)thread_call_enter1_delayed( wrapTC->TChdl, (void *)wrapTC, wrapTC->deadline );
505*0f4c859eSApple OSS Distributions 
506*0f4c859eSApple OSS Distributions 	/* Did cyclic_remove request a wakeup call when this thread call was re-armed? */
507*0f4c859eSApple OSS Distributions 	if (wrapTC->when.cyt_interval == WAKEUP_REAPER) {
508*0f4c859eSApple OSS Distributions 		thread_wakeup((event_t)wrapTC);
509*0f4c859eSApple OSS Distributions 	}
510*0f4c859eSApple OSS Distributions }
511*0f4c859eSApple OSS Distributions 
512*0f4c859eSApple OSS Distributions cyclic_id_t
cyclic_add(cyc_handler_t * handler,cyc_time_t * when)513*0f4c859eSApple OSS Distributions cyclic_add(cyc_handler_t *handler, cyc_time_t *when)
514*0f4c859eSApple OSS Distributions {
515*0f4c859eSApple OSS Distributions 	uint64_t now;
516*0f4c859eSApple OSS Distributions 
517*0f4c859eSApple OSS Distributions 	wrap_thread_call_t *wrapTC = kalloc_type(wrap_thread_call_t, Z_ZERO | Z_WAITOK);
518*0f4c859eSApple OSS Distributions 	if (NULL == wrapTC) {
519*0f4c859eSApple OSS Distributions 		return CYCLIC_NONE;
520*0f4c859eSApple OSS Distributions 	}
521*0f4c859eSApple OSS Distributions 
522*0f4c859eSApple OSS Distributions 	wrapTC->TChdl = thread_call_allocate( _cyclic_apply, NULL );
523*0f4c859eSApple OSS Distributions 	wrapTC->hdlr = *handler;
524*0f4c859eSApple OSS Distributions 	wrapTC->when = *when;
525*0f4c859eSApple OSS Distributions 
526*0f4c859eSApple OSS Distributions 	ASSERT(when->cyt_when == 0);
527*0f4c859eSApple OSS Distributions 	ASSERT(when->cyt_interval < WAKEUP_REAPER);
528*0f4c859eSApple OSS Distributions 
529*0f4c859eSApple OSS Distributions 	nanoseconds_to_absolutetime(wrapTC->when.cyt_interval, (uint64_t *)&wrapTC->when.cyt_interval);
530*0f4c859eSApple OSS Distributions 
531*0f4c859eSApple OSS Distributions 	now = mach_absolute_time();
532*0f4c859eSApple OSS Distributions 	wrapTC->deadline = now;
533*0f4c859eSApple OSS Distributions 
534*0f4c859eSApple OSS Distributions 	clock_deadline_for_periodic_event( wrapTC->when.cyt_interval, now, &(wrapTC->deadline));
535*0f4c859eSApple OSS Distributions 	(void)thread_call_enter1_delayed( wrapTC->TChdl, (void *)wrapTC, wrapTC->deadline );
536*0f4c859eSApple OSS Distributions 
537*0f4c859eSApple OSS Distributions 	return (cyclic_id_t)wrapTC;
538*0f4c859eSApple OSS Distributions }
539*0f4c859eSApple OSS Distributions 
540*0f4c859eSApple OSS Distributions static void
noop_cyh_func(void * ignore)541*0f4c859eSApple OSS Distributions noop_cyh_func(void * ignore)
542*0f4c859eSApple OSS Distributions {
543*0f4c859eSApple OSS Distributions #pragma unused(ignore)
544*0f4c859eSApple OSS Distributions }
545*0f4c859eSApple OSS Distributions 
546*0f4c859eSApple OSS Distributions void
cyclic_remove(cyclic_id_t cyclic)547*0f4c859eSApple OSS Distributions cyclic_remove(cyclic_id_t cyclic)
548*0f4c859eSApple OSS Distributions {
549*0f4c859eSApple OSS Distributions 	wrap_thread_call_t *wrapTC = (wrap_thread_call_t *)cyclic;
550*0f4c859eSApple OSS Distributions 
551*0f4c859eSApple OSS Distributions 	ASSERT(cyclic != CYCLIC_NONE);
552*0f4c859eSApple OSS Distributions 
553*0f4c859eSApple OSS Distributions 	while (!thread_call_cancel(wrapTC->TChdl)) {
554*0f4c859eSApple OSS Distributions 		int ret = assert_wait(wrapTC, THREAD_UNINT);
555*0f4c859eSApple OSS Distributions 		ASSERT(ret == THREAD_WAITING);
556*0f4c859eSApple OSS Distributions 
557*0f4c859eSApple OSS Distributions 		wrapTC->when.cyt_interval = WAKEUP_REAPER;
558*0f4c859eSApple OSS Distributions 
559*0f4c859eSApple OSS Distributions 		ret = thread_block(THREAD_CONTINUE_NULL);
560*0f4c859eSApple OSS Distributions 		ASSERT(ret == THREAD_AWAKENED);
561*0f4c859eSApple OSS Distributions 	}
562*0f4c859eSApple OSS Distributions 
563*0f4c859eSApple OSS Distributions 	if (thread_call_free(wrapTC->TChdl)) {
564*0f4c859eSApple OSS Distributions 		kfree_type(wrap_thread_call_t, wrapTC);
565*0f4c859eSApple OSS Distributions 	} else {
566*0f4c859eSApple OSS Distributions 		/* Gut this cyclic and move on ... */
567*0f4c859eSApple OSS Distributions 		wrapTC->hdlr.cyh_func = noop_cyh_func;
568*0f4c859eSApple OSS Distributions 		wrapTC->when.cyt_interval = NEARLY_FOREVER;
569*0f4c859eSApple OSS Distributions 	}
570*0f4c859eSApple OSS Distributions }
571*0f4c859eSApple OSS Distributions 
572*0f4c859eSApple OSS Distributions int
ddi_driver_major(dev_info_t * devi)573*0f4c859eSApple OSS Distributions ddi_driver_major(dev_info_t     *devi)
574*0f4c859eSApple OSS Distributions {
575*0f4c859eSApple OSS Distributions 	return (int)major(CAST_DOWN_EXPLICIT(int, devi));
576*0f4c859eSApple OSS Distributions }
577*0f4c859eSApple OSS Distributions 
578*0f4c859eSApple OSS Distributions int
ddi_create_minor_node(dev_info_t * dip,const char * name,int spec_type,minor_t minor_num,const char * node_type,int flag)579*0f4c859eSApple OSS Distributions ddi_create_minor_node(dev_info_t *dip, const char *name, int spec_type,
580*0f4c859eSApple OSS Distributions     minor_t minor_num, const char *node_type, int flag)
581*0f4c859eSApple OSS Distributions {
582*0f4c859eSApple OSS Distributions #pragma unused(spec_type,node_type,flag)
583*0f4c859eSApple OSS Distributions 	dev_t dev = makedev( ddi_driver_major(dip), minor_num );
584*0f4c859eSApple OSS Distributions 
585*0f4c859eSApple OSS Distributions 	if (NULL == devfs_make_node( dev, DEVFS_CHAR, UID_ROOT, GID_WHEEL, 0666, "%s", name )) {
586*0f4c859eSApple OSS Distributions 		return DDI_FAILURE;
587*0f4c859eSApple OSS Distributions 	} else {
588*0f4c859eSApple OSS Distributions 		return DDI_SUCCESS;
589*0f4c859eSApple OSS Distributions 	}
590*0f4c859eSApple OSS Distributions }
591*0f4c859eSApple OSS Distributions 
592*0f4c859eSApple OSS Distributions void
ddi_remove_minor_node(dev_info_t * dip,char * name)593*0f4c859eSApple OSS Distributions ddi_remove_minor_node(dev_info_t *dip, char *name)
594*0f4c859eSApple OSS Distributions {
595*0f4c859eSApple OSS Distributions #pragma unused(dip,name)
596*0f4c859eSApple OSS Distributions /* XXX called from dtrace_detach, so NOTREACHED for now. */
597*0f4c859eSApple OSS Distributions }
598*0f4c859eSApple OSS Distributions 
599*0f4c859eSApple OSS Distributions major_t
getemajor(dev_t d)600*0f4c859eSApple OSS Distributions getemajor( dev_t d )
601*0f4c859eSApple OSS Distributions {
602*0f4c859eSApple OSS Distributions 	return (major_t) major(d);
603*0f4c859eSApple OSS Distributions }
604*0f4c859eSApple OSS Distributions 
605*0f4c859eSApple OSS Distributions minor_t
getminor(dev_t d)606*0f4c859eSApple OSS Distributions getminor( dev_t d )
607*0f4c859eSApple OSS Distributions {
608*0f4c859eSApple OSS Distributions 	return (minor_t) minor(d);
609*0f4c859eSApple OSS Distributions }
610*0f4c859eSApple OSS Distributions 
611*0f4c859eSApple OSS Distributions extern void Debugger(const char*);
612*0f4c859eSApple OSS Distributions 
613*0f4c859eSApple OSS Distributions void
debug_enter(char * c)614*0f4c859eSApple OSS Distributions debug_enter(char *c)
615*0f4c859eSApple OSS Distributions {
616*0f4c859eSApple OSS Distributions 	Debugger(c);
617*0f4c859eSApple OSS Distributions }
618*0f4c859eSApple OSS Distributions 
619*0f4c859eSApple OSS Distributions /*
620*0f4c859eSApple OSS Distributions  * kmem
621*0f4c859eSApple OSS Distributions  */
622*0f4c859eSApple OSS Distributions 
623*0f4c859eSApple OSS Distributions // rdar://88962505
624*0f4c859eSApple OSS Distributions __typed_allocators_ignore_push
625*0f4c859eSApple OSS Distributions 
626*0f4c859eSApple OSS Distributions void *
dt_kmem_alloc_tag(size_t size,int kmflag,vm_tag_t tag)627*0f4c859eSApple OSS Distributions dt_kmem_alloc_tag(size_t size, int kmflag, vm_tag_t tag)
628*0f4c859eSApple OSS Distributions {
629*0f4c859eSApple OSS Distributions #pragma unused(kmflag)
630*0f4c859eSApple OSS Distributions 
631*0f4c859eSApple OSS Distributions /*
632*0f4c859eSApple OSS Distributions  * We ignore the M_NOWAIT bit in kmflag (all of kmflag, in fact).
633*0f4c859eSApple OSS Distributions  * Requests larger than 8K with M_NOWAIT fail in kalloc_ext.
634*0f4c859eSApple OSS Distributions  */
635*0f4c859eSApple OSS Distributions 	return kheap_alloc_tag(KHEAP_DTRACE, size, Z_WAITOK, tag);
636*0f4c859eSApple OSS Distributions }
637*0f4c859eSApple OSS Distributions 
638*0f4c859eSApple OSS Distributions void *
dt_kmem_zalloc_tag(size_t size,int kmflag,vm_tag_t tag)639*0f4c859eSApple OSS Distributions dt_kmem_zalloc_tag(size_t size, int kmflag, vm_tag_t tag)
640*0f4c859eSApple OSS Distributions {
641*0f4c859eSApple OSS Distributions #pragma unused(kmflag)
642*0f4c859eSApple OSS Distributions 
643*0f4c859eSApple OSS Distributions /*
644*0f4c859eSApple OSS Distributions  * We ignore the M_NOWAIT bit in kmflag (all of kmflag, in fact).
645*0f4c859eSApple OSS Distributions  * Requests larger than 8K with M_NOWAIT fail in kalloc_ext.
646*0f4c859eSApple OSS Distributions  */
647*0f4c859eSApple OSS Distributions 	return kheap_alloc_tag(KHEAP_DTRACE, size, Z_WAITOK | Z_ZERO, tag);
648*0f4c859eSApple OSS Distributions }
649*0f4c859eSApple OSS Distributions 
650*0f4c859eSApple OSS Distributions void
dt_kmem_free(void * buf,size_t size)651*0f4c859eSApple OSS Distributions dt_kmem_free(void *buf, size_t size)
652*0f4c859eSApple OSS Distributions {
653*0f4c859eSApple OSS Distributions 	kheap_free(KHEAP_DTRACE, buf, size);
654*0f4c859eSApple OSS Distributions }
655*0f4c859eSApple OSS Distributions 
656*0f4c859eSApple OSS Distributions __typed_allocators_ignore_pop
657*0f4c859eSApple OSS Distributions 
658*0f4c859eSApple OSS Distributions 
659*0f4c859eSApple OSS Distributions /*
660*0f4c859eSApple OSS Distributions  * aligned dt_kmem allocator
661*0f4c859eSApple OSS Distributions  * align should be a power of two
662*0f4c859eSApple OSS Distributions  */
663*0f4c859eSApple OSS Distributions 
664*0f4c859eSApple OSS Distributions void*
dt_kmem_alloc_aligned_tag(size_t size,size_t align,int kmflag,vm_tag_t tag)665*0f4c859eSApple OSS Distributions dt_kmem_alloc_aligned_tag(size_t size, size_t align, int kmflag, vm_tag_t tag)
666*0f4c859eSApple OSS Distributions {
667*0f4c859eSApple OSS Distributions 	void *mem, **addr_to_free;
668*0f4c859eSApple OSS Distributions 	intptr_t mem_aligned;
669*0f4c859eSApple OSS Distributions 	size_t *size_to_free, hdr_size;
670*0f4c859eSApple OSS Distributions 
671*0f4c859eSApple OSS Distributions 	/* Must be a power of two. */
672*0f4c859eSApple OSS Distributions 	assert(align != 0);
673*0f4c859eSApple OSS Distributions 	assert((align & (align - 1)) == 0);
674*0f4c859eSApple OSS Distributions 
675*0f4c859eSApple OSS Distributions 	/*
676*0f4c859eSApple OSS Distributions 	 * We are going to add a header to the allocation. It contains
677*0f4c859eSApple OSS Distributions 	 * the address to free and the total size of the buffer.
678*0f4c859eSApple OSS Distributions 	 */
679*0f4c859eSApple OSS Distributions 	hdr_size = sizeof(size_t) + sizeof(void*);
680*0f4c859eSApple OSS Distributions 	mem = dt_kmem_alloc_tag(size + align + hdr_size, kmflag, tag);
681*0f4c859eSApple OSS Distributions 	if (mem == NULL) {
682*0f4c859eSApple OSS Distributions 		return NULL;
683*0f4c859eSApple OSS Distributions 	}
684*0f4c859eSApple OSS Distributions 
685*0f4c859eSApple OSS Distributions 	mem_aligned = (intptr_t) (((intptr_t) mem + align + hdr_size) & ~(align - 1));
686*0f4c859eSApple OSS Distributions 
687*0f4c859eSApple OSS Distributions 	/* Write the address to free in the header. */
688*0f4c859eSApple OSS Distributions 	addr_to_free = (void**) (mem_aligned - sizeof(void*));
689*0f4c859eSApple OSS Distributions 	*addr_to_free = mem;
690*0f4c859eSApple OSS Distributions 
691*0f4c859eSApple OSS Distributions 	/* Write the size to free in the header. */
692*0f4c859eSApple OSS Distributions 	size_to_free = (size_t*) (mem_aligned - hdr_size);
693*0f4c859eSApple OSS Distributions 	*size_to_free = size + align + hdr_size;
694*0f4c859eSApple OSS Distributions 
695*0f4c859eSApple OSS Distributions 	return (void*) mem_aligned;
696*0f4c859eSApple OSS Distributions }
697*0f4c859eSApple OSS Distributions 
698*0f4c859eSApple OSS Distributions void*
dt_kmem_zalloc_aligned_tag(size_t size,size_t align,int kmflag,vm_tag_t tag)699*0f4c859eSApple OSS Distributions dt_kmem_zalloc_aligned_tag(size_t size, size_t align, int kmflag, vm_tag_t tag)
700*0f4c859eSApple OSS Distributions {
701*0f4c859eSApple OSS Distributions 	void* buf;
702*0f4c859eSApple OSS Distributions 
703*0f4c859eSApple OSS Distributions 	buf = dt_kmem_alloc_aligned_tag(size, align, kmflag, tag);
704*0f4c859eSApple OSS Distributions 
705*0f4c859eSApple OSS Distributions 	if (!buf) {
706*0f4c859eSApple OSS Distributions 		return NULL;
707*0f4c859eSApple OSS Distributions 	}
708*0f4c859eSApple OSS Distributions 
709*0f4c859eSApple OSS Distributions 	bzero(buf, size);
710*0f4c859eSApple OSS Distributions 
711*0f4c859eSApple OSS Distributions 	return buf;
712*0f4c859eSApple OSS Distributions }
713*0f4c859eSApple OSS Distributions 
714*0f4c859eSApple OSS Distributions void
dt_kmem_free_aligned(void * buf,size_t size)715*0f4c859eSApple OSS Distributions dt_kmem_free_aligned(void* buf, size_t size)
716*0f4c859eSApple OSS Distributions {
717*0f4c859eSApple OSS Distributions #pragma unused(size)
718*0f4c859eSApple OSS Distributions 	intptr_t ptr = (intptr_t) buf;
719*0f4c859eSApple OSS Distributions 	void **addr_to_free = (void**) (ptr - sizeof(void*));
720*0f4c859eSApple OSS Distributions 	size_t *size_to_free = (size_t*) (ptr - (sizeof(size_t) + sizeof(void*)));
721*0f4c859eSApple OSS Distributions 
722*0f4c859eSApple OSS Distributions 	if (buf == NULL) {
723*0f4c859eSApple OSS Distributions 		return;
724*0f4c859eSApple OSS Distributions 	}
725*0f4c859eSApple OSS Distributions 
726*0f4c859eSApple OSS Distributions 	dt_kmem_free(*addr_to_free, *size_to_free);
727*0f4c859eSApple OSS Distributions }
728*0f4c859eSApple OSS Distributions 
729*0f4c859eSApple OSS Distributions /*
730*0f4c859eSApple OSS Distributions  * vmem (Solaris "slab" allocator) used by DTrace solely to hand out resource ids
731*0f4c859eSApple OSS Distributions  */
732*0f4c859eSApple OSS Distributions typedef unsigned int u_daddr_t;
733*0f4c859eSApple OSS Distributions #include "blist.h"
734*0f4c859eSApple OSS Distributions 
735*0f4c859eSApple OSS Distributions /* By passing around blist *handles*, the underlying blist can be resized as needed. */
736*0f4c859eSApple OSS Distributions struct blist_hdl {
737*0f4c859eSApple OSS Distributions 	blist_t blist;
738*0f4c859eSApple OSS Distributions };
739*0f4c859eSApple OSS Distributions 
740*0f4c859eSApple OSS Distributions vmem_t *
vmem_create(const char * name,void * base,size_t size,size_t quantum,void * ignore5,void * ignore6,vmem_t * source,size_t qcache_max,int vmflag)741*0f4c859eSApple OSS Distributions vmem_create(const char *name, void *base, size_t size, size_t quantum, void *ignore5,
742*0f4c859eSApple OSS Distributions     void *ignore6, vmem_t *source, size_t qcache_max, int vmflag)
743*0f4c859eSApple OSS Distributions {
744*0f4c859eSApple OSS Distributions #pragma unused(name,quantum,ignore5,ignore6,source,qcache_max,vmflag)
745*0f4c859eSApple OSS Distributions 	blist_t bl;
746*0f4c859eSApple OSS Distributions 	struct blist_hdl *p = kalloc_type(struct blist_hdl, Z_WAITOK);
747*0f4c859eSApple OSS Distributions 
748*0f4c859eSApple OSS Distributions 	ASSERT(quantum == 1);
749*0f4c859eSApple OSS Distributions 	ASSERT(NULL == ignore5);
750*0f4c859eSApple OSS Distributions 	ASSERT(NULL == ignore6);
751*0f4c859eSApple OSS Distributions 	ASSERT(NULL == source);
752*0f4c859eSApple OSS Distributions 	ASSERT(0 == qcache_max);
753*0f4c859eSApple OSS Distributions 	ASSERT(size <= INT32_MAX);
754*0f4c859eSApple OSS Distributions 	ASSERT(vmflag & VMC_IDENTIFIER);
755*0f4c859eSApple OSS Distributions 
756*0f4c859eSApple OSS Distributions 	size = MIN(128, size); /* Clamp to 128 initially, since the underlying data structure is pre-allocated */
757*0f4c859eSApple OSS Distributions 
758*0f4c859eSApple OSS Distributions 	p->blist = bl = blist_create((daddr_t)size);
759*0f4c859eSApple OSS Distributions 	blist_free(bl, 0, (daddr_t)size);
760*0f4c859eSApple OSS Distributions 	if (base) {
761*0f4c859eSApple OSS Distributions 		blist_alloc( bl, (daddr_t)(uintptr_t)base );   /* Chomp off initial ID(s) */
762*0f4c859eSApple OSS Distributions 	}
763*0f4c859eSApple OSS Distributions 	return (vmem_t *)p;
764*0f4c859eSApple OSS Distributions }
765*0f4c859eSApple OSS Distributions 
766*0f4c859eSApple OSS Distributions void *
vmem_alloc(vmem_t * vmp,size_t size,int vmflag)767*0f4c859eSApple OSS Distributions vmem_alloc(vmem_t *vmp, size_t size, int vmflag)
768*0f4c859eSApple OSS Distributions {
769*0f4c859eSApple OSS Distributions #pragma unused(vmflag)
770*0f4c859eSApple OSS Distributions 	struct blist_hdl *q = (struct blist_hdl *)vmp;
771*0f4c859eSApple OSS Distributions 	blist_t bl = q->blist;
772*0f4c859eSApple OSS Distributions 	daddr_t p;
773*0f4c859eSApple OSS Distributions 
774*0f4c859eSApple OSS Distributions 	p = blist_alloc(bl, (daddr_t)size);
775*0f4c859eSApple OSS Distributions 
776*0f4c859eSApple OSS Distributions 	if (p == SWAPBLK_NONE) {
777*0f4c859eSApple OSS Distributions 		blist_resize(&bl, (bl->bl_blocks) << 1, 1);
778*0f4c859eSApple OSS Distributions 		q->blist = bl;
779*0f4c859eSApple OSS Distributions 		p = blist_alloc(bl, (daddr_t)size);
780*0f4c859eSApple OSS Distributions 		if (p == SWAPBLK_NONE) {
781*0f4c859eSApple OSS Distributions 			panic("vmem_alloc: failure after blist_resize!");
782*0f4c859eSApple OSS Distributions 		}
783*0f4c859eSApple OSS Distributions 	}
784*0f4c859eSApple OSS Distributions 
785*0f4c859eSApple OSS Distributions 	return (void *)(uintptr_t)p;
786*0f4c859eSApple OSS Distributions }
787*0f4c859eSApple OSS Distributions 
788*0f4c859eSApple OSS Distributions void
vmem_free(vmem_t * vmp,void * vaddr,size_t size)789*0f4c859eSApple OSS Distributions vmem_free(vmem_t *vmp, void *vaddr, size_t size)
790*0f4c859eSApple OSS Distributions {
791*0f4c859eSApple OSS Distributions 	struct blist_hdl *p = (struct blist_hdl *)vmp;
792*0f4c859eSApple OSS Distributions 
793*0f4c859eSApple OSS Distributions 	blist_free( p->blist, (daddr_t)(uintptr_t)vaddr, (daddr_t)size );
794*0f4c859eSApple OSS Distributions }
795*0f4c859eSApple OSS Distributions 
796*0f4c859eSApple OSS Distributions void
vmem_destroy(vmem_t * vmp)797*0f4c859eSApple OSS Distributions vmem_destroy(vmem_t *vmp)
798*0f4c859eSApple OSS Distributions {
799*0f4c859eSApple OSS Distributions 	struct blist_hdl *p = (struct blist_hdl *)vmp;
800*0f4c859eSApple OSS Distributions 
801*0f4c859eSApple OSS Distributions 	blist_destroy( p->blist );
802*0f4c859eSApple OSS Distributions 	kfree_type(struct blist_hdl, p);
803*0f4c859eSApple OSS Distributions }
804*0f4c859eSApple OSS Distributions 
805*0f4c859eSApple OSS Distributions /*
806*0f4c859eSApple OSS Distributions  * Timing
807*0f4c859eSApple OSS Distributions  */
808*0f4c859eSApple OSS Distributions 
809*0f4c859eSApple OSS Distributions /*
810*0f4c859eSApple OSS Distributions  * dtrace_gethrestime() provides the "walltimestamp", a value that is anchored at
811*0f4c859eSApple OSS Distributions  * January 1, 1970. Because it can be called from probe context, it must take no locks.
812*0f4c859eSApple OSS Distributions  */
813*0f4c859eSApple OSS Distributions 
814*0f4c859eSApple OSS Distributions hrtime_t
dtrace_gethrestime(void)815*0f4c859eSApple OSS Distributions dtrace_gethrestime(void)
816*0f4c859eSApple OSS Distributions {
817*0f4c859eSApple OSS Distributions 	clock_sec_t             secs;
818*0f4c859eSApple OSS Distributions 	clock_nsec_t    nanosecs;
819*0f4c859eSApple OSS Distributions 	uint64_t                secs64, ns64;
820*0f4c859eSApple OSS Distributions 
821*0f4c859eSApple OSS Distributions 	clock_get_calendar_nanotime_nowait(&secs, &nanosecs);
822*0f4c859eSApple OSS Distributions 	secs64 = (uint64_t)secs;
823*0f4c859eSApple OSS Distributions 	ns64 = (uint64_t)nanosecs;
824*0f4c859eSApple OSS Distributions 
825*0f4c859eSApple OSS Distributions 	ns64 = ns64 + (secs64 * 1000000000LL);
826*0f4c859eSApple OSS Distributions 	return ns64;
827*0f4c859eSApple OSS Distributions }
828*0f4c859eSApple OSS Distributions 
829*0f4c859eSApple OSS Distributions /*
830*0f4c859eSApple OSS Distributions  * dtrace_gethrtime() provides high-resolution timestamps with machine-dependent origin.
831*0f4c859eSApple OSS Distributions  * Hence its primary use is to specify intervals.
832*0f4c859eSApple OSS Distributions  */
833*0f4c859eSApple OSS Distributions 
834*0f4c859eSApple OSS Distributions hrtime_t
dtrace_abs_to_nano(uint64_t elapsed)835*0f4c859eSApple OSS Distributions dtrace_abs_to_nano(uint64_t elapsed)
836*0f4c859eSApple OSS Distributions {
837*0f4c859eSApple OSS Distributions 	static mach_timebase_info_data_t    sTimebaseInfo = { 0, 0 };
838*0f4c859eSApple OSS Distributions 
839*0f4c859eSApple OSS Distributions 	/*
840*0f4c859eSApple OSS Distributions 	 * If this is the first time we've run, get the timebase.
841*0f4c859eSApple OSS Distributions 	 * We can use denom == 0 to indicate that sTimebaseInfo is
842*0f4c859eSApple OSS Distributions 	 * uninitialised because it makes no sense to have a zero
843*0f4c859eSApple OSS Distributions 	 * denominator in a fraction.
844*0f4c859eSApple OSS Distributions 	 */
845*0f4c859eSApple OSS Distributions 
846*0f4c859eSApple OSS Distributions 	if (sTimebaseInfo.denom == 0) {
847*0f4c859eSApple OSS Distributions 		(void) clock_timebase_info(&sTimebaseInfo);
848*0f4c859eSApple OSS Distributions 	}
849*0f4c859eSApple OSS Distributions 
850*0f4c859eSApple OSS Distributions 	/*
851*0f4c859eSApple OSS Distributions 	 * Convert to nanoseconds.
852*0f4c859eSApple OSS Distributions 	 * return (elapsed * (uint64_t)sTimebaseInfo.numer)/(uint64_t)sTimebaseInfo.denom;
853*0f4c859eSApple OSS Distributions 	 *
854*0f4c859eSApple OSS Distributions 	 * Provided the final result is representable in 64 bits the following maneuver will
855*0f4c859eSApple OSS Distributions 	 * deliver that result without intermediate overflow.
856*0f4c859eSApple OSS Distributions 	 */
857*0f4c859eSApple OSS Distributions 	if (sTimebaseInfo.denom == sTimebaseInfo.numer) {
858*0f4c859eSApple OSS Distributions 		return elapsed;
859*0f4c859eSApple OSS Distributions 	} else if (sTimebaseInfo.denom == 1) {
860*0f4c859eSApple OSS Distributions 		return elapsed * (uint64_t)sTimebaseInfo.numer;
861*0f4c859eSApple OSS Distributions 	} else {
862*0f4c859eSApple OSS Distributions 		/* Decompose elapsed = eta32 * 2^32 + eps32: */
863*0f4c859eSApple OSS Distributions 		uint64_t eta32 = elapsed >> 32;
864*0f4c859eSApple OSS Distributions 		uint64_t eps32 = elapsed & 0x00000000ffffffffLL;
865*0f4c859eSApple OSS Distributions 
866*0f4c859eSApple OSS Distributions 		uint32_t numer = sTimebaseInfo.numer, denom = sTimebaseInfo.denom;
867*0f4c859eSApple OSS Distributions 
868*0f4c859eSApple OSS Distributions 		/* Form product of elapsed64 (decomposed) and numer: */
869*0f4c859eSApple OSS Distributions 		uint64_t mu64 = numer * eta32;
870*0f4c859eSApple OSS Distributions 		uint64_t lambda64 = numer * eps32;
871*0f4c859eSApple OSS Distributions 
872*0f4c859eSApple OSS Distributions 		/* Divide the constituents by denom: */
873*0f4c859eSApple OSS Distributions 		uint64_t q32 = mu64 / denom;
874*0f4c859eSApple OSS Distributions 		uint64_t r32 = mu64 - (q32 * denom); /* mu64 % denom */
875*0f4c859eSApple OSS Distributions 
876*0f4c859eSApple OSS Distributions 		return (q32 << 32) + ((r32 << 32) + lambda64) / denom;
877*0f4c859eSApple OSS Distributions 	}
878*0f4c859eSApple OSS Distributions }
879*0f4c859eSApple OSS Distributions 
880*0f4c859eSApple OSS Distributions hrtime_t
dtrace_gethrtime(void)881*0f4c859eSApple OSS Distributions dtrace_gethrtime(void)
882*0f4c859eSApple OSS Distributions {
883*0f4c859eSApple OSS Distributions 	static uint64_t        start = 0;
884*0f4c859eSApple OSS Distributions 
885*0f4c859eSApple OSS Distributions 	if (start == 0) {
886*0f4c859eSApple OSS Distributions 		start = mach_absolute_time();
887*0f4c859eSApple OSS Distributions 	}
888*0f4c859eSApple OSS Distributions 
889*0f4c859eSApple OSS Distributions 	return dtrace_abs_to_nano(mach_absolute_time() - start);
890*0f4c859eSApple OSS Distributions }
891*0f4c859eSApple OSS Distributions 
892*0f4c859eSApple OSS Distributions /*
893*0f4c859eSApple OSS Distributions  * Atomicity and synchronization
894*0f4c859eSApple OSS Distributions  */
895*0f4c859eSApple OSS Distributions uint32_t
dtrace_cas32(uint32_t * target,uint32_t cmp,uint32_t new)896*0f4c859eSApple OSS Distributions dtrace_cas32(uint32_t *target, uint32_t cmp, uint32_t new)
897*0f4c859eSApple OSS Distributions {
898*0f4c859eSApple OSS Distributions 	if (OSCompareAndSwap((UInt32)cmp, (UInt32)new, (volatile UInt32 *)target )) {
899*0f4c859eSApple OSS Distributions 		return cmp;
900*0f4c859eSApple OSS Distributions 	} else {
901*0f4c859eSApple OSS Distributions 		return ~cmp; /* Must return something *other* than cmp */
902*0f4c859eSApple OSS Distributions 	}
903*0f4c859eSApple OSS Distributions }
904*0f4c859eSApple OSS Distributions 
905*0f4c859eSApple OSS Distributions void *
dtrace_casptr(void * target,void * cmp,void * new)906*0f4c859eSApple OSS Distributions dtrace_casptr(void *target, void *cmp, void *new)
907*0f4c859eSApple OSS Distributions {
908*0f4c859eSApple OSS Distributions 	if (OSCompareAndSwapPtr( cmp, new, (void**)target )) {
909*0f4c859eSApple OSS Distributions 		return cmp;
910*0f4c859eSApple OSS Distributions 	} else {
911*0f4c859eSApple OSS Distributions 		return (void *)(~(uintptr_t)cmp); /* Must return something *other* than cmp */
912*0f4c859eSApple OSS Distributions 	}
913*0f4c859eSApple OSS Distributions }
914*0f4c859eSApple OSS Distributions 
915*0f4c859eSApple OSS Distributions /*
916*0f4c859eSApple OSS Distributions  * Interrupt manipulation
917*0f4c859eSApple OSS Distributions  */
918*0f4c859eSApple OSS Distributions dtrace_icookie_t
dtrace_interrupt_disable(void)919*0f4c859eSApple OSS Distributions dtrace_interrupt_disable(void)
920*0f4c859eSApple OSS Distributions {
921*0f4c859eSApple OSS Distributions 	return (dtrace_icookie_t)ml_set_interrupts_enabled(FALSE);
922*0f4c859eSApple OSS Distributions }
923*0f4c859eSApple OSS Distributions 
924*0f4c859eSApple OSS Distributions void
dtrace_interrupt_enable(dtrace_icookie_t reenable)925*0f4c859eSApple OSS Distributions dtrace_interrupt_enable(dtrace_icookie_t reenable)
926*0f4c859eSApple OSS Distributions {
927*0f4c859eSApple OSS Distributions 	(void)ml_set_interrupts_enabled((boolean_t)reenable);
928*0f4c859eSApple OSS Distributions }
929*0f4c859eSApple OSS Distributions 
930*0f4c859eSApple OSS Distributions /*
931*0f4c859eSApple OSS Distributions  * MP coordination
932*0f4c859eSApple OSS Distributions  */
933*0f4c859eSApple OSS Distributions static void
dtrace_sync_func(void)934*0f4c859eSApple OSS Distributions dtrace_sync_func(void)
935*0f4c859eSApple OSS Distributions {
936*0f4c859eSApple OSS Distributions }
937*0f4c859eSApple OSS Distributions 
938*0f4c859eSApple OSS Distributions /*
939*0f4c859eSApple OSS Distributions  * dtrace_sync() is not called from probe context.
940*0f4c859eSApple OSS Distributions  */
941*0f4c859eSApple OSS Distributions void
dtrace_sync(void)942*0f4c859eSApple OSS Distributions dtrace_sync(void)
943*0f4c859eSApple OSS Distributions {
944*0f4c859eSApple OSS Distributions 	dtrace_xcall(DTRACE_CPUALL, (dtrace_xcall_t)dtrace_sync_func, NULL);
945*0f4c859eSApple OSS Distributions }
946*0f4c859eSApple OSS Distributions 
947*0f4c859eSApple OSS Distributions /*
948*0f4c859eSApple OSS Distributions  * The dtrace_copyin/out/instr and dtrace_fuword* routines can be called from probe context.
949*0f4c859eSApple OSS Distributions  */
950*0f4c859eSApple OSS Distributions 
951*0f4c859eSApple OSS Distributions extern kern_return_t dtrace_copyio_preflight(addr64_t);
952*0f4c859eSApple OSS Distributions extern kern_return_t dtrace_copyio_postflight(addr64_t);
953*0f4c859eSApple OSS Distributions 
954*0f4c859eSApple OSS Distributions static int
dtrace_copycheck(user_addr_t uaddr,uintptr_t kaddr,size_t size)955*0f4c859eSApple OSS Distributions dtrace_copycheck(user_addr_t uaddr, uintptr_t kaddr, size_t size)
956*0f4c859eSApple OSS Distributions {
957*0f4c859eSApple OSS Distributions #pragma unused(kaddr)
958*0f4c859eSApple OSS Distributions 
959*0f4c859eSApple OSS Distributions 	ASSERT(kaddr + size >= kaddr);
960*0f4c859eSApple OSS Distributions 
961*0f4c859eSApple OSS Distributions 	if (uaddr + size < uaddr ||             /* Avoid address wrap. */
962*0f4c859eSApple OSS Distributions 	    KERN_FAILURE == dtrace_copyio_preflight(uaddr)) {   /* Machine specific setup/constraints. */
963*0f4c859eSApple OSS Distributions 		DTRACE_CPUFLAG_SET(CPU_DTRACE_BADADDR);
964*0f4c859eSApple OSS Distributions 		cpu_core[CPU->cpu_id].cpuc_dtrace_illval = uaddr;
965*0f4c859eSApple OSS Distributions 		return 0;
966*0f4c859eSApple OSS Distributions 	}
967*0f4c859eSApple OSS Distributions 	return 1;
968*0f4c859eSApple OSS Distributions }
969*0f4c859eSApple OSS Distributions 
970*0f4c859eSApple OSS Distributions void
dtrace_copyin(user_addr_t src,uintptr_t dst,size_t len,volatile uint16_t * flags)971*0f4c859eSApple OSS Distributions dtrace_copyin(user_addr_t src, uintptr_t dst, size_t len, volatile uint16_t *flags)
972*0f4c859eSApple OSS Distributions {
973*0f4c859eSApple OSS Distributions #pragma unused(flags)
974*0f4c859eSApple OSS Distributions 
975*0f4c859eSApple OSS Distributions 	if (dtrace_copycheck( src, dst, len )) {
976*0f4c859eSApple OSS Distributions 		if (copyin((const user_addr_t)src, (char *)dst, (vm_size_t)len)) {
977*0f4c859eSApple OSS Distributions 			DTRACE_CPUFLAG_SET(CPU_DTRACE_BADADDR);
978*0f4c859eSApple OSS Distributions 			cpu_core[CPU->cpu_id].cpuc_dtrace_illval = src;
979*0f4c859eSApple OSS Distributions 		}
980*0f4c859eSApple OSS Distributions 		dtrace_copyio_postflight(src);
981*0f4c859eSApple OSS Distributions 	}
982*0f4c859eSApple OSS Distributions }
983*0f4c859eSApple OSS Distributions 
984*0f4c859eSApple OSS Distributions void
dtrace_copyinstr(user_addr_t src,uintptr_t dst,size_t len,volatile uint16_t * flags)985*0f4c859eSApple OSS Distributions dtrace_copyinstr(user_addr_t src, uintptr_t dst, size_t len, volatile uint16_t *flags)
986*0f4c859eSApple OSS Distributions {
987*0f4c859eSApple OSS Distributions #pragma unused(flags)
988*0f4c859eSApple OSS Distributions 
989*0f4c859eSApple OSS Distributions 	size_t actual;
990*0f4c859eSApple OSS Distributions 
991*0f4c859eSApple OSS Distributions 	if (dtrace_copycheck( src, dst, len )) {
992*0f4c859eSApple OSS Distributions 		/*  copyin as many as 'len' bytes. */
993*0f4c859eSApple OSS Distributions 		int error = copyinstr((const user_addr_t)src, (char *)dst, (vm_size_t)len, &actual);
994*0f4c859eSApple OSS Distributions 
995*0f4c859eSApple OSS Distributions 		/*
996*0f4c859eSApple OSS Distributions 		 * ENAMETOOLONG is returned when 'len' bytes have been copied in but the NUL terminator was
997*0f4c859eSApple OSS Distributions 		 * not encountered. That does not require raising CPU_DTRACE_BADADDR, and we press on.
998*0f4c859eSApple OSS Distributions 		 * Note that we do *not* stuff a NUL terminator when returning ENAMETOOLONG, that's left
999*0f4c859eSApple OSS Distributions 		 * to the caller.
1000*0f4c859eSApple OSS Distributions 		 */
1001*0f4c859eSApple OSS Distributions 		if (error && error != ENAMETOOLONG) {
1002*0f4c859eSApple OSS Distributions 			DTRACE_CPUFLAG_SET(CPU_DTRACE_BADADDR);
1003*0f4c859eSApple OSS Distributions 			cpu_core[CPU->cpu_id].cpuc_dtrace_illval = src;
1004*0f4c859eSApple OSS Distributions 		}
1005*0f4c859eSApple OSS Distributions 		dtrace_copyio_postflight(src);
1006*0f4c859eSApple OSS Distributions 	}
1007*0f4c859eSApple OSS Distributions }
1008*0f4c859eSApple OSS Distributions 
1009*0f4c859eSApple OSS Distributions void
dtrace_copyout(uintptr_t src,user_addr_t dst,size_t len,volatile uint16_t * flags)1010*0f4c859eSApple OSS Distributions dtrace_copyout(uintptr_t src, user_addr_t dst, size_t len, volatile uint16_t *flags)
1011*0f4c859eSApple OSS Distributions {
1012*0f4c859eSApple OSS Distributions #pragma unused(flags)
1013*0f4c859eSApple OSS Distributions 
1014*0f4c859eSApple OSS Distributions 	if (dtrace_copycheck( dst, src, len )) {
1015*0f4c859eSApple OSS Distributions 		if (copyout((const void *)src, dst, (vm_size_t)len)) {
1016*0f4c859eSApple OSS Distributions 			DTRACE_CPUFLAG_SET(CPU_DTRACE_BADADDR);
1017*0f4c859eSApple OSS Distributions 			cpu_core[CPU->cpu_id].cpuc_dtrace_illval = dst;
1018*0f4c859eSApple OSS Distributions 		}
1019*0f4c859eSApple OSS Distributions 		dtrace_copyio_postflight(dst);
1020*0f4c859eSApple OSS Distributions 	}
1021*0f4c859eSApple OSS Distributions }
1022*0f4c859eSApple OSS Distributions 
1023*0f4c859eSApple OSS Distributions void
dtrace_copyoutstr(uintptr_t src,user_addr_t dst,size_t len,volatile uint16_t * flags)1024*0f4c859eSApple OSS Distributions dtrace_copyoutstr(uintptr_t src, user_addr_t dst, size_t len, volatile uint16_t *flags)
1025*0f4c859eSApple OSS Distributions {
1026*0f4c859eSApple OSS Distributions #pragma unused(flags)
1027*0f4c859eSApple OSS Distributions 
1028*0f4c859eSApple OSS Distributions 	size_t actual;
1029*0f4c859eSApple OSS Distributions 
1030*0f4c859eSApple OSS Distributions 	if (dtrace_copycheck( dst, src, len )) {
1031*0f4c859eSApple OSS Distributions 		/*
1032*0f4c859eSApple OSS Distributions 		 * ENAMETOOLONG is returned when 'len' bytes have been copied out but the NUL terminator was
1033*0f4c859eSApple OSS Distributions 		 * not encountered. We raise CPU_DTRACE_BADADDR in that case.
1034*0f4c859eSApple OSS Distributions 		 * Note that we do *not* stuff a NUL terminator when returning ENAMETOOLONG, that's left
1035*0f4c859eSApple OSS Distributions 		 * to the caller.
1036*0f4c859eSApple OSS Distributions 		 */
1037*0f4c859eSApple OSS Distributions 		if (copyoutstr((const void *)src, dst, (size_t)len, &actual)) {
1038*0f4c859eSApple OSS Distributions 			DTRACE_CPUFLAG_SET(CPU_DTRACE_BADADDR);
1039*0f4c859eSApple OSS Distributions 			cpu_core[CPU->cpu_id].cpuc_dtrace_illval = dst;
1040*0f4c859eSApple OSS Distributions 		}
1041*0f4c859eSApple OSS Distributions 		dtrace_copyio_postflight(dst);
1042*0f4c859eSApple OSS Distributions 	}
1043*0f4c859eSApple OSS Distributions }
1044*0f4c859eSApple OSS Distributions 
1045*0f4c859eSApple OSS Distributions extern const int copysize_limit_panic;
1046*0f4c859eSApple OSS Distributions 
1047*0f4c859eSApple OSS Distributions int
dtrace_copy_maxsize(void)1048*0f4c859eSApple OSS Distributions dtrace_copy_maxsize(void)
1049*0f4c859eSApple OSS Distributions {
1050*0f4c859eSApple OSS Distributions 	return copysize_limit_panic;
1051*0f4c859eSApple OSS Distributions }
1052*0f4c859eSApple OSS Distributions 
1053*0f4c859eSApple OSS Distributions 
1054*0f4c859eSApple OSS Distributions int
dtrace_buffer_copyout(const void * kaddr,user_addr_t uaddr,vm_size_t nbytes)1055*0f4c859eSApple OSS Distributions dtrace_buffer_copyout(const void *kaddr, user_addr_t uaddr, vm_size_t nbytes)
1056*0f4c859eSApple OSS Distributions {
1057*0f4c859eSApple OSS Distributions 	int maxsize = dtrace_copy_maxsize();
1058*0f4c859eSApple OSS Distributions 	/*
1059*0f4c859eSApple OSS Distributions 	 * Partition the copyout in copysize_limit_panic-sized chunks
1060*0f4c859eSApple OSS Distributions 	 */
1061*0f4c859eSApple OSS Distributions 	while (nbytes >= (vm_size_t)maxsize) {
1062*0f4c859eSApple OSS Distributions 		if (copyout(kaddr, uaddr, maxsize) != 0) {
1063*0f4c859eSApple OSS Distributions 			return EFAULT;
1064*0f4c859eSApple OSS Distributions 		}
1065*0f4c859eSApple OSS Distributions 
1066*0f4c859eSApple OSS Distributions 		nbytes -= maxsize;
1067*0f4c859eSApple OSS Distributions 		uaddr += maxsize;
1068*0f4c859eSApple OSS Distributions 		kaddr = (const void *)((uintptr_t)kaddr + maxsize);
1069*0f4c859eSApple OSS Distributions 	}
1070*0f4c859eSApple OSS Distributions 	if (nbytes > 0) {
1071*0f4c859eSApple OSS Distributions 		if (copyout(kaddr, uaddr, nbytes) != 0) {
1072*0f4c859eSApple OSS Distributions 			return EFAULT;
1073*0f4c859eSApple OSS Distributions 		}
1074*0f4c859eSApple OSS Distributions 	}
1075*0f4c859eSApple OSS Distributions 
1076*0f4c859eSApple OSS Distributions 	return 0;
1077*0f4c859eSApple OSS Distributions }
1078*0f4c859eSApple OSS Distributions 
1079*0f4c859eSApple OSS Distributions uint8_t
dtrace_fuword8(user_addr_t uaddr)1080*0f4c859eSApple OSS Distributions dtrace_fuword8(user_addr_t uaddr)
1081*0f4c859eSApple OSS Distributions {
1082*0f4c859eSApple OSS Distributions 	uint8_t ret = 0;
1083*0f4c859eSApple OSS Distributions 
1084*0f4c859eSApple OSS Distributions 	DTRACE_CPUFLAG_SET(CPU_DTRACE_NOFAULT);
1085*0f4c859eSApple OSS Distributions 	if (dtrace_copycheck( uaddr, (uintptr_t)&ret, sizeof(ret))) {
1086*0f4c859eSApple OSS Distributions 		if (copyin((const user_addr_t)uaddr, (char *)&ret, sizeof(ret))) {
1087*0f4c859eSApple OSS Distributions 			DTRACE_CPUFLAG_SET(CPU_DTRACE_BADADDR);
1088*0f4c859eSApple OSS Distributions 			cpu_core[CPU->cpu_id].cpuc_dtrace_illval = uaddr;
1089*0f4c859eSApple OSS Distributions 		}
1090*0f4c859eSApple OSS Distributions 		dtrace_copyio_postflight(uaddr);
1091*0f4c859eSApple OSS Distributions 	}
1092*0f4c859eSApple OSS Distributions 	DTRACE_CPUFLAG_CLEAR(CPU_DTRACE_NOFAULT);
1093*0f4c859eSApple OSS Distributions 
1094*0f4c859eSApple OSS Distributions 	return ret;
1095*0f4c859eSApple OSS Distributions }
1096*0f4c859eSApple OSS Distributions 
1097*0f4c859eSApple OSS Distributions uint16_t
dtrace_fuword16(user_addr_t uaddr)1098*0f4c859eSApple OSS Distributions dtrace_fuword16(user_addr_t uaddr)
1099*0f4c859eSApple OSS Distributions {
1100*0f4c859eSApple OSS Distributions 	uint16_t ret = 0;
1101*0f4c859eSApple OSS Distributions 
1102*0f4c859eSApple OSS Distributions 	DTRACE_CPUFLAG_SET(CPU_DTRACE_NOFAULT);
1103*0f4c859eSApple OSS Distributions 	if (dtrace_copycheck( uaddr, (uintptr_t)&ret, sizeof(ret))) {
1104*0f4c859eSApple OSS Distributions 		if (copyin((const user_addr_t)uaddr, (char *)&ret, sizeof(ret))) {
1105*0f4c859eSApple OSS Distributions 			DTRACE_CPUFLAG_SET(CPU_DTRACE_BADADDR);
1106*0f4c859eSApple OSS Distributions 			cpu_core[CPU->cpu_id].cpuc_dtrace_illval = uaddr;
1107*0f4c859eSApple OSS Distributions 		}
1108*0f4c859eSApple OSS Distributions 		dtrace_copyio_postflight(uaddr);
1109*0f4c859eSApple OSS Distributions 	}
1110*0f4c859eSApple OSS Distributions 	DTRACE_CPUFLAG_CLEAR(CPU_DTRACE_NOFAULT);
1111*0f4c859eSApple OSS Distributions 
1112*0f4c859eSApple OSS Distributions 	return ret;
1113*0f4c859eSApple OSS Distributions }
1114*0f4c859eSApple OSS Distributions 
1115*0f4c859eSApple OSS Distributions uint32_t
dtrace_fuword32(user_addr_t uaddr)1116*0f4c859eSApple OSS Distributions dtrace_fuword32(user_addr_t uaddr)
1117*0f4c859eSApple OSS Distributions {
1118*0f4c859eSApple OSS Distributions 	uint32_t ret = 0;
1119*0f4c859eSApple OSS Distributions 
1120*0f4c859eSApple OSS Distributions 	DTRACE_CPUFLAG_SET(CPU_DTRACE_NOFAULT);
1121*0f4c859eSApple OSS Distributions 	if (dtrace_copycheck( uaddr, (uintptr_t)&ret, sizeof(ret))) {
1122*0f4c859eSApple OSS Distributions 		if (copyin((const user_addr_t)uaddr, (char *)&ret, sizeof(ret))) {
1123*0f4c859eSApple OSS Distributions 			DTRACE_CPUFLAG_SET(CPU_DTRACE_BADADDR);
1124*0f4c859eSApple OSS Distributions 			cpu_core[CPU->cpu_id].cpuc_dtrace_illval = uaddr;
1125*0f4c859eSApple OSS Distributions 		}
1126*0f4c859eSApple OSS Distributions 		dtrace_copyio_postflight(uaddr);
1127*0f4c859eSApple OSS Distributions 	}
1128*0f4c859eSApple OSS Distributions 	DTRACE_CPUFLAG_CLEAR(CPU_DTRACE_NOFAULT);
1129*0f4c859eSApple OSS Distributions 
1130*0f4c859eSApple OSS Distributions 	return ret;
1131*0f4c859eSApple OSS Distributions }
1132*0f4c859eSApple OSS Distributions 
1133*0f4c859eSApple OSS Distributions uint64_t
dtrace_fuword64(user_addr_t uaddr)1134*0f4c859eSApple OSS Distributions dtrace_fuword64(user_addr_t uaddr)
1135*0f4c859eSApple OSS Distributions {
1136*0f4c859eSApple OSS Distributions 	uint64_t ret = 0;
1137*0f4c859eSApple OSS Distributions 
1138*0f4c859eSApple OSS Distributions 	DTRACE_CPUFLAG_SET(CPU_DTRACE_NOFAULT);
1139*0f4c859eSApple OSS Distributions 	if (dtrace_copycheck( uaddr, (uintptr_t)&ret, sizeof(ret))) {
1140*0f4c859eSApple OSS Distributions 		if (copyin((const user_addr_t)uaddr, (char *)&ret, sizeof(ret))) {
1141*0f4c859eSApple OSS Distributions 			DTRACE_CPUFLAG_SET(CPU_DTRACE_BADADDR);
1142*0f4c859eSApple OSS Distributions 			cpu_core[CPU->cpu_id].cpuc_dtrace_illval = uaddr;
1143*0f4c859eSApple OSS Distributions 		}
1144*0f4c859eSApple OSS Distributions 		dtrace_copyio_postflight(uaddr);
1145*0f4c859eSApple OSS Distributions 	}
1146*0f4c859eSApple OSS Distributions 	DTRACE_CPUFLAG_CLEAR(CPU_DTRACE_NOFAULT);
1147*0f4c859eSApple OSS Distributions 
1148*0f4c859eSApple OSS Distributions 	return ret;
1149*0f4c859eSApple OSS Distributions }
1150*0f4c859eSApple OSS Distributions 
1151*0f4c859eSApple OSS Distributions /*
1152*0f4c859eSApple OSS Distributions  * Emulation of Solaris fuword / suword
1153*0f4c859eSApple OSS Distributions  * Called from the fasttrap provider, so the use of copyin/out requires fewer safegaurds.
1154*0f4c859eSApple OSS Distributions  */
1155*0f4c859eSApple OSS Distributions 
1156*0f4c859eSApple OSS Distributions int
fuword8(user_addr_t uaddr,uint8_t * value)1157*0f4c859eSApple OSS Distributions fuword8(user_addr_t uaddr, uint8_t *value)
1158*0f4c859eSApple OSS Distributions {
1159*0f4c859eSApple OSS Distributions 	if (copyin((const user_addr_t)uaddr, (char *)value, sizeof(uint8_t)) != 0) {
1160*0f4c859eSApple OSS Distributions 		return -1;
1161*0f4c859eSApple OSS Distributions 	}
1162*0f4c859eSApple OSS Distributions 
1163*0f4c859eSApple OSS Distributions 	return 0;
1164*0f4c859eSApple OSS Distributions }
1165*0f4c859eSApple OSS Distributions 
1166*0f4c859eSApple OSS Distributions int
fuword16(user_addr_t uaddr,uint16_t * value)1167*0f4c859eSApple OSS Distributions fuword16(user_addr_t uaddr, uint16_t *value)
1168*0f4c859eSApple OSS Distributions {
1169*0f4c859eSApple OSS Distributions 	if (copyin((const user_addr_t)uaddr, (char *)value, sizeof(uint16_t)) != 0) {
1170*0f4c859eSApple OSS Distributions 		return -1;
1171*0f4c859eSApple OSS Distributions 	}
1172*0f4c859eSApple OSS Distributions 
1173*0f4c859eSApple OSS Distributions 	return 0;
1174*0f4c859eSApple OSS Distributions }
1175*0f4c859eSApple OSS Distributions 
1176*0f4c859eSApple OSS Distributions int
fuword32(user_addr_t uaddr,uint32_t * value)1177*0f4c859eSApple OSS Distributions fuword32(user_addr_t uaddr, uint32_t *value)
1178*0f4c859eSApple OSS Distributions {
1179*0f4c859eSApple OSS Distributions 	if (copyin((const user_addr_t)uaddr, (char *)value, sizeof(uint32_t)) != 0) {
1180*0f4c859eSApple OSS Distributions 		return -1;
1181*0f4c859eSApple OSS Distributions 	}
1182*0f4c859eSApple OSS Distributions 
1183*0f4c859eSApple OSS Distributions 	return 0;
1184*0f4c859eSApple OSS Distributions }
1185*0f4c859eSApple OSS Distributions 
1186*0f4c859eSApple OSS Distributions int
fuword64(user_addr_t uaddr,uint64_t * value)1187*0f4c859eSApple OSS Distributions fuword64(user_addr_t uaddr, uint64_t *value)
1188*0f4c859eSApple OSS Distributions {
1189*0f4c859eSApple OSS Distributions 	if (copyin((const user_addr_t)uaddr, (char *)value, sizeof(uint64_t)) != 0) {
1190*0f4c859eSApple OSS Distributions 		return -1;
1191*0f4c859eSApple OSS Distributions 	}
1192*0f4c859eSApple OSS Distributions 
1193*0f4c859eSApple OSS Distributions 	return 0;
1194*0f4c859eSApple OSS Distributions }
1195*0f4c859eSApple OSS Distributions 
1196*0f4c859eSApple OSS Distributions void
fuword32_noerr(user_addr_t uaddr,uint32_t * value)1197*0f4c859eSApple OSS Distributions fuword32_noerr(user_addr_t uaddr, uint32_t *value)
1198*0f4c859eSApple OSS Distributions {
1199*0f4c859eSApple OSS Distributions 	if (copyin((const user_addr_t)uaddr, (char *)value, sizeof(uint32_t))) {
1200*0f4c859eSApple OSS Distributions 		*value = 0;
1201*0f4c859eSApple OSS Distributions 	}
1202*0f4c859eSApple OSS Distributions }
1203*0f4c859eSApple OSS Distributions 
1204*0f4c859eSApple OSS Distributions void
fuword64_noerr(user_addr_t uaddr,uint64_t * value)1205*0f4c859eSApple OSS Distributions fuword64_noerr(user_addr_t uaddr, uint64_t *value)
1206*0f4c859eSApple OSS Distributions {
1207*0f4c859eSApple OSS Distributions 	if (copyin((const user_addr_t)uaddr, (char *)value, sizeof(uint64_t))) {
1208*0f4c859eSApple OSS Distributions 		*value = 0;
1209*0f4c859eSApple OSS Distributions 	}
1210*0f4c859eSApple OSS Distributions }
1211*0f4c859eSApple OSS Distributions 
1212*0f4c859eSApple OSS Distributions int
suword64(user_addr_t addr,uint64_t value)1213*0f4c859eSApple OSS Distributions suword64(user_addr_t addr, uint64_t value)
1214*0f4c859eSApple OSS Distributions {
1215*0f4c859eSApple OSS Distributions 	if (copyout((const void *)&value, addr, sizeof(value)) != 0) {
1216*0f4c859eSApple OSS Distributions 		return -1;
1217*0f4c859eSApple OSS Distributions 	}
1218*0f4c859eSApple OSS Distributions 
1219*0f4c859eSApple OSS Distributions 	return 0;
1220*0f4c859eSApple OSS Distributions }
1221*0f4c859eSApple OSS Distributions 
1222*0f4c859eSApple OSS Distributions int
suword32(user_addr_t addr,uint32_t value)1223*0f4c859eSApple OSS Distributions suword32(user_addr_t addr, uint32_t value)
1224*0f4c859eSApple OSS Distributions {
1225*0f4c859eSApple OSS Distributions 	if (copyout((const void *)&value, addr, sizeof(value)) != 0) {
1226*0f4c859eSApple OSS Distributions 		return -1;
1227*0f4c859eSApple OSS Distributions 	}
1228*0f4c859eSApple OSS Distributions 
1229*0f4c859eSApple OSS Distributions 	return 0;
1230*0f4c859eSApple OSS Distributions }
1231*0f4c859eSApple OSS Distributions 
1232*0f4c859eSApple OSS Distributions /*
1233*0f4c859eSApple OSS Distributions  * Miscellaneous
1234*0f4c859eSApple OSS Distributions  */
1235*0f4c859eSApple OSS Distributions extern boolean_t dtrace_tally_fault(user_addr_t);
1236*0f4c859eSApple OSS Distributions 
1237*0f4c859eSApple OSS Distributions boolean_t
dtrace_tally_fault(user_addr_t uaddr)1238*0f4c859eSApple OSS Distributions dtrace_tally_fault(user_addr_t uaddr)
1239*0f4c859eSApple OSS Distributions {
1240*0f4c859eSApple OSS Distributions 	DTRACE_CPUFLAG_SET(CPU_DTRACE_BADADDR);
1241*0f4c859eSApple OSS Distributions 	cpu_core[CPU->cpu_id].cpuc_dtrace_illval = uaddr;
1242*0f4c859eSApple OSS Distributions 	return DTRACE_CPUFLAG_ISSET(CPU_DTRACE_NOFAULT) ? TRUE : FALSE;
1243*0f4c859eSApple OSS Distributions }
1244*0f4c859eSApple OSS Distributions 
1245*0f4c859eSApple OSS Distributions #define TOTTY   0x02
1246*0f4c859eSApple OSS Distributions extern int prf(const char *, va_list, int, struct tty *); /* bsd/kern/subr_prf.h */
1247*0f4c859eSApple OSS Distributions 
1248*0f4c859eSApple OSS Distributions int
vuprintf(const char * format,va_list ap)1249*0f4c859eSApple OSS Distributions vuprintf(const char *format, va_list ap)
1250*0f4c859eSApple OSS Distributions {
1251*0f4c859eSApple OSS Distributions 	return prf(format, ap, TOTTY, NULL);
1252*0f4c859eSApple OSS Distributions }
1253*0f4c859eSApple OSS Distributions 
1254*0f4c859eSApple OSS Distributions /* Not called from probe context */
1255*0f4c859eSApple OSS Distributions void
cmn_err(int level,const char * format,...)1256*0f4c859eSApple OSS Distributions cmn_err( int level, const char *format, ... )
1257*0f4c859eSApple OSS Distributions {
1258*0f4c859eSApple OSS Distributions #pragma unused(level)
1259*0f4c859eSApple OSS Distributions 	va_list alist;
1260*0f4c859eSApple OSS Distributions 
1261*0f4c859eSApple OSS Distributions 	va_start(alist, format);
1262*0f4c859eSApple OSS Distributions 	vuprintf(format, alist);
1263*0f4c859eSApple OSS Distributions 	va_end(alist);
1264*0f4c859eSApple OSS Distributions 	uprintf("\n");
1265*0f4c859eSApple OSS Distributions }
1266*0f4c859eSApple OSS Distributions 
1267*0f4c859eSApple OSS Distributions const void*
bsearch(const void * key,const void * base0,size_t nmemb,size_t size,int (* compar)(const void *,const void *))1268*0f4c859eSApple OSS Distributions bsearch(const void *key, const void *base0, size_t nmemb, size_t size, int (*compar)(const void *, const void *))
1269*0f4c859eSApple OSS Distributions {
1270*0f4c859eSApple OSS Distributions 	const char *base = base0;
1271*0f4c859eSApple OSS Distributions 	size_t lim;
1272*0f4c859eSApple OSS Distributions 	int cmp;
1273*0f4c859eSApple OSS Distributions 	const void *p;
1274*0f4c859eSApple OSS Distributions 	for (lim = nmemb; lim != 0; lim >>= 1) {
1275*0f4c859eSApple OSS Distributions 		p = base + (lim >> 1) * size;
1276*0f4c859eSApple OSS Distributions 		cmp = (*compar)(key, p);
1277*0f4c859eSApple OSS Distributions 		if (cmp == 0) {
1278*0f4c859eSApple OSS Distributions 			return p;
1279*0f4c859eSApple OSS Distributions 		}
1280*0f4c859eSApple OSS Distributions 		if (cmp > 0) {  /* key > p: move right */
1281*0f4c859eSApple OSS Distributions 			base = (const char *)p + size;
1282*0f4c859eSApple OSS Distributions 			lim--;
1283*0f4c859eSApple OSS Distributions 		}               /* else move left */
1284*0f4c859eSApple OSS Distributions 	}
1285*0f4c859eSApple OSS Distributions 	return NULL;
1286*0f4c859eSApple OSS Distributions }
1287*0f4c859eSApple OSS Distributions 
1288*0f4c859eSApple OSS Distributions /*
1289*0f4c859eSApple OSS Distributions  * Runtime and ABI
1290*0f4c859eSApple OSS Distributions  */
1291*0f4c859eSApple OSS Distributions uintptr_t
dtrace_caller(int ignore)1292*0f4c859eSApple OSS Distributions dtrace_caller(int ignore)
1293*0f4c859eSApple OSS Distributions {
1294*0f4c859eSApple OSS Distributions #pragma unused(ignore)
1295*0f4c859eSApple OSS Distributions 	return -1; /* Just as in Solaris dtrace_asm.s */
1296*0f4c859eSApple OSS Distributions }
1297*0f4c859eSApple OSS Distributions 
1298*0f4c859eSApple OSS Distributions int
dtrace_getstackdepth(int aframes)1299*0f4c859eSApple OSS Distributions dtrace_getstackdepth(int aframes)
1300*0f4c859eSApple OSS Distributions {
1301*0f4c859eSApple OSS Distributions 	struct frame *fp = (struct frame *)__builtin_frame_address(0);
1302*0f4c859eSApple OSS Distributions 	struct frame *nextfp, *minfp, *stacktop;
1303*0f4c859eSApple OSS Distributions 	int depth = 0;
1304*0f4c859eSApple OSS Distributions 	int on_intr;
1305*0f4c859eSApple OSS Distributions 
1306*0f4c859eSApple OSS Distributions 	if ((on_intr = CPU_ON_INTR(CPU)) != 0) {
1307*0f4c859eSApple OSS Distributions 		stacktop = (struct frame *)dtrace_get_cpu_int_stack_top();
1308*0f4c859eSApple OSS Distributions 	} else {
1309*0f4c859eSApple OSS Distributions 		stacktop = (struct frame *)(dtrace_get_kernel_stack(current_thread()) + kernel_stack_size);
1310*0f4c859eSApple OSS Distributions 	}
1311*0f4c859eSApple OSS Distributions 
1312*0f4c859eSApple OSS Distributions 	minfp = fp;
1313*0f4c859eSApple OSS Distributions 
1314*0f4c859eSApple OSS Distributions 	aframes++;
1315*0f4c859eSApple OSS Distributions 
1316*0f4c859eSApple OSS Distributions 	for (;;) {
1317*0f4c859eSApple OSS Distributions 		depth++;
1318*0f4c859eSApple OSS Distributions 
1319*0f4c859eSApple OSS Distributions 		nextfp = *(struct frame **)fp;
1320*0f4c859eSApple OSS Distributions 
1321*0f4c859eSApple OSS Distributions 		if (nextfp <= minfp || nextfp >= stacktop) {
1322*0f4c859eSApple OSS Distributions 			if (on_intr) {
1323*0f4c859eSApple OSS Distributions 				/*
1324*0f4c859eSApple OSS Distributions 				 * Hop from interrupt stack to thread stack.
1325*0f4c859eSApple OSS Distributions 				 */
1326*0f4c859eSApple OSS Distributions 				vm_offset_t kstack_base = dtrace_get_kernel_stack(current_thread());
1327*0f4c859eSApple OSS Distributions 
1328*0f4c859eSApple OSS Distributions 				minfp = (struct frame *)kstack_base;
1329*0f4c859eSApple OSS Distributions 				stacktop = (struct frame *)(kstack_base + kernel_stack_size);
1330*0f4c859eSApple OSS Distributions 
1331*0f4c859eSApple OSS Distributions 				on_intr = 0;
1332*0f4c859eSApple OSS Distributions 				continue;
1333*0f4c859eSApple OSS Distributions 			}
1334*0f4c859eSApple OSS Distributions 			break;
1335*0f4c859eSApple OSS Distributions 		}
1336*0f4c859eSApple OSS Distributions 
1337*0f4c859eSApple OSS Distributions 		fp = nextfp;
1338*0f4c859eSApple OSS Distributions 		minfp = fp;
1339*0f4c859eSApple OSS Distributions 	}
1340*0f4c859eSApple OSS Distributions 
1341*0f4c859eSApple OSS Distributions 	if (depth <= aframes) {
1342*0f4c859eSApple OSS Distributions 		return 0;
1343*0f4c859eSApple OSS Distributions 	}
1344*0f4c859eSApple OSS Distributions 
1345*0f4c859eSApple OSS Distributions 	return depth - aframes;
1346*0f4c859eSApple OSS Distributions }
1347*0f4c859eSApple OSS Distributions 
1348*0f4c859eSApple OSS Distributions int
dtrace_addr_in_module(const void * addr,const struct modctl * ctl)1349*0f4c859eSApple OSS Distributions dtrace_addr_in_module(const void* addr, const struct modctl *ctl)
1350*0f4c859eSApple OSS Distributions {
1351*0f4c859eSApple OSS Distributions 	return OSKextKextForAddress(addr) == (void*)ctl->mod_address;
1352*0f4c859eSApple OSS Distributions }
1353*0f4c859eSApple OSS Distributions 
1354*0f4c859eSApple OSS Distributions /*
1355*0f4c859eSApple OSS Distributions  * Unconsidered
1356*0f4c859eSApple OSS Distributions  */
1357*0f4c859eSApple OSS Distributions void
dtrace_vtime_enable(void)1358*0f4c859eSApple OSS Distributions dtrace_vtime_enable(void)
1359*0f4c859eSApple OSS Distributions {
1360*0f4c859eSApple OSS Distributions }
1361*0f4c859eSApple OSS Distributions 
1362*0f4c859eSApple OSS Distributions void
dtrace_vtime_disable(void)1363*0f4c859eSApple OSS Distributions dtrace_vtime_disable(void)
1364*0f4c859eSApple OSS Distributions {
1365*0f4c859eSApple OSS Distributions }
1366