1*f1d3cbfaSSteven Rostedt (Google) /* SPDX-License-Identifier: GPL-2.0 */
2*f1d3cbfaSSteven Rostedt (Google) #ifndef __TRACE_PROBE_KERNEL_H_
3*f1d3cbfaSSteven Rostedt (Google) #define __TRACE_PROBE_KERNEL_H_
4*f1d3cbfaSSteven Rostedt (Google) 
5*f1d3cbfaSSteven Rostedt (Google) /*
6*f1d3cbfaSSteven Rostedt (Google)  * This depends on trace_probe.h, but can not include it due to
7*f1d3cbfaSSteven Rostedt (Google)  * the way trace_probe_tmpl.h is used by trace_kprobe.c and trace_eprobe.c.
8*f1d3cbfaSSteven Rostedt (Google)  * Which means that any other user must include trace_probe.h before including
9*f1d3cbfaSSteven Rostedt (Google)  * this file.
10*f1d3cbfaSSteven Rostedt (Google)  */
11*f1d3cbfaSSteven Rostedt (Google) /* Return the length of string -- including null terminal byte */
12*f1d3cbfaSSteven Rostedt (Google) static nokprobe_inline int
13*f1d3cbfaSSteven Rostedt (Google) kern_fetch_store_strlen_user(unsigned long addr)
14*f1d3cbfaSSteven Rostedt (Google) {
15*f1d3cbfaSSteven Rostedt (Google) 	const void __user *uaddr =  (__force const void __user *)addr;
16*f1d3cbfaSSteven Rostedt (Google) 
17*f1d3cbfaSSteven Rostedt (Google) 	return strnlen_user_nofault(uaddr, MAX_STRING_SIZE);
18*f1d3cbfaSSteven Rostedt (Google) }
19*f1d3cbfaSSteven Rostedt (Google) 
20*f1d3cbfaSSteven Rostedt (Google) /* Return the length of string -- including null terminal byte */
21*f1d3cbfaSSteven Rostedt (Google) static nokprobe_inline int
22*f1d3cbfaSSteven Rostedt (Google) kern_fetch_store_strlen(unsigned long addr)
23*f1d3cbfaSSteven Rostedt (Google) {
24*f1d3cbfaSSteven Rostedt (Google) 	int ret, len = 0;
25*f1d3cbfaSSteven Rostedt (Google) 	u8 c;
26*f1d3cbfaSSteven Rostedt (Google) 
27*f1d3cbfaSSteven Rostedt (Google) #ifdef CONFIG_ARCH_HAS_NON_OVERLAPPING_ADDRESS_SPACE
28*f1d3cbfaSSteven Rostedt (Google) 	if (addr < TASK_SIZE)
29*f1d3cbfaSSteven Rostedt (Google) 		return kern_fetch_store_strlen_user(addr);
30*f1d3cbfaSSteven Rostedt (Google) #endif
31*f1d3cbfaSSteven Rostedt (Google) 
32*f1d3cbfaSSteven Rostedt (Google) 	do {
33*f1d3cbfaSSteven Rostedt (Google) 		ret = copy_from_kernel_nofault(&c, (u8 *)addr + len, 1);
34*f1d3cbfaSSteven Rostedt (Google) 		len++;
35*f1d3cbfaSSteven Rostedt (Google) 	} while (c && ret == 0 && len < MAX_STRING_SIZE);
36*f1d3cbfaSSteven Rostedt (Google) 
37*f1d3cbfaSSteven Rostedt (Google) 	return (ret < 0) ? ret : len;
38*f1d3cbfaSSteven Rostedt (Google) }
39*f1d3cbfaSSteven Rostedt (Google) 
40*f1d3cbfaSSteven Rostedt (Google) /*
41*f1d3cbfaSSteven Rostedt (Google)  * Fetch a null-terminated string from user. Caller MUST set *(u32 *)buf
42*f1d3cbfaSSteven Rostedt (Google)  * with max length and relative data location.
43*f1d3cbfaSSteven Rostedt (Google)  */
44*f1d3cbfaSSteven Rostedt (Google) static nokprobe_inline int
45*f1d3cbfaSSteven Rostedt (Google) kern_fetch_store_string_user(unsigned long addr, void *dest, void *base)
46*f1d3cbfaSSteven Rostedt (Google) {
47*f1d3cbfaSSteven Rostedt (Google) 	const void __user *uaddr =  (__force const void __user *)addr;
48*f1d3cbfaSSteven Rostedt (Google) 	int maxlen = get_loc_len(*(u32 *)dest);
49*f1d3cbfaSSteven Rostedt (Google) 	void *__dest;
50*f1d3cbfaSSteven Rostedt (Google) 	long ret;
51*f1d3cbfaSSteven Rostedt (Google) 
52*f1d3cbfaSSteven Rostedt (Google) 	if (unlikely(!maxlen))
53*f1d3cbfaSSteven Rostedt (Google) 		return -ENOMEM;
54*f1d3cbfaSSteven Rostedt (Google) 
55*f1d3cbfaSSteven Rostedt (Google) 	__dest = get_loc_data(dest, base);
56*f1d3cbfaSSteven Rostedt (Google) 
57*f1d3cbfaSSteven Rostedt (Google) 	ret = strncpy_from_user_nofault(__dest, uaddr, maxlen);
58*f1d3cbfaSSteven Rostedt (Google) 	if (ret >= 0)
59*f1d3cbfaSSteven Rostedt (Google) 		*(u32 *)dest = make_data_loc(ret, __dest - base);
60*f1d3cbfaSSteven Rostedt (Google) 
61*f1d3cbfaSSteven Rostedt (Google) 	return ret;
62*f1d3cbfaSSteven Rostedt (Google) }
63*f1d3cbfaSSteven Rostedt (Google) 
64*f1d3cbfaSSteven Rostedt (Google) /*
65*f1d3cbfaSSteven Rostedt (Google)  * Fetch a null-terminated string. Caller MUST set *(u32 *)buf with max
66*f1d3cbfaSSteven Rostedt (Google)  * length and relative data location.
67*f1d3cbfaSSteven Rostedt (Google)  */
68*f1d3cbfaSSteven Rostedt (Google) static nokprobe_inline int
69*f1d3cbfaSSteven Rostedt (Google) kern_fetch_store_string(unsigned long addr, void *dest, void *base)
70*f1d3cbfaSSteven Rostedt (Google) {
71*f1d3cbfaSSteven Rostedt (Google) 	int maxlen = get_loc_len(*(u32 *)dest);
72*f1d3cbfaSSteven Rostedt (Google) 	void *__dest;
73*f1d3cbfaSSteven Rostedt (Google) 	long ret;
74*f1d3cbfaSSteven Rostedt (Google) 
75*f1d3cbfaSSteven Rostedt (Google) #ifdef CONFIG_ARCH_HAS_NON_OVERLAPPING_ADDRESS_SPACE
76*f1d3cbfaSSteven Rostedt (Google) 	if ((unsigned long)addr < TASK_SIZE)
77*f1d3cbfaSSteven Rostedt (Google) 		return kern_fetch_store_string_user(addr, dest, base);
78*f1d3cbfaSSteven Rostedt (Google) #endif
79*f1d3cbfaSSteven Rostedt (Google) 
80*f1d3cbfaSSteven Rostedt (Google) 	if (unlikely(!maxlen))
81*f1d3cbfaSSteven Rostedt (Google) 		return -ENOMEM;
82*f1d3cbfaSSteven Rostedt (Google) 
83*f1d3cbfaSSteven Rostedt (Google) 	__dest = get_loc_data(dest, base);
84*f1d3cbfaSSteven Rostedt (Google) 
85*f1d3cbfaSSteven Rostedt (Google) 	/*
86*f1d3cbfaSSteven Rostedt (Google) 	 * Try to get string again, since the string can be changed while
87*f1d3cbfaSSteven Rostedt (Google) 	 * probing.
88*f1d3cbfaSSteven Rostedt (Google) 	 */
89*f1d3cbfaSSteven Rostedt (Google) 	ret = strncpy_from_kernel_nofault(__dest, (void *)addr, maxlen);
90*f1d3cbfaSSteven Rostedt (Google) 	if (ret >= 0)
91*f1d3cbfaSSteven Rostedt (Google) 		*(u32 *)dest = make_data_loc(ret, __dest - base);
92*f1d3cbfaSSteven Rostedt (Google) 
93*f1d3cbfaSSteven Rostedt (Google) 	return ret;
94*f1d3cbfaSSteven Rostedt (Google) }
95*f1d3cbfaSSteven Rostedt (Google) 
96*f1d3cbfaSSteven Rostedt (Google) #endif /* __TRACE_PROBE_KERNEL_H_ */
97