xref: /openbmc/linux/kernel/kcov.c (revision 67b3d3cca385507c4c8b6ad97b823415e038e3c8)
1b2441318SGreg Kroah-Hartman // SPDX-License-Identifier: GPL-2.0
25c9a8750SDmitry Vyukov #define pr_fmt(fmt) "kcov: " fmt
35c9a8750SDmitry Vyukov 
436f05ae8SAndrey Ryabinin #define DISABLE_BRANCH_PROFILING
5db862358SKefeng Wang #include <linux/atomic.h>
65c9a8750SDmitry Vyukov #include <linux/compiler.h>
7db862358SKefeng Wang #include <linux/errno.h>
8db862358SKefeng Wang #include <linux/export.h>
95c9a8750SDmitry Vyukov #include <linux/types.h>
105c9a8750SDmitry Vyukov #include <linux/file.h>
115c9a8750SDmitry Vyukov #include <linux/fs.h>
12eec028c9SAndrey Konovalov #include <linux/hashtable.h>
13db862358SKefeng Wang #include <linux/init.h>
145c9a8750SDmitry Vyukov #include <linux/mm.h>
15db862358SKefeng Wang #include <linux/preempt.h>
165c9a8750SDmitry Vyukov #include <linux/printk.h>
17166ad0e1SKefeng Wang #include <linux/sched.h>
185c9a8750SDmitry Vyukov #include <linux/slab.h>
195c9a8750SDmitry Vyukov #include <linux/spinlock.h>
205c9a8750SDmitry Vyukov #include <linux/vmalloc.h>
215c9a8750SDmitry Vyukov #include <linux/debugfs.h>
225c9a8750SDmitry Vyukov #include <linux/uaccess.h>
235c9a8750SDmitry Vyukov #include <linux/kcov.h>
2439e07cb6SElena Reshetova #include <linux/refcount.h>
25eec028c9SAndrey Konovalov #include <linux/log2.h>
264983f0abSAlexander Popov #include <asm/setup.h>
275c9a8750SDmitry Vyukov 
28eec028c9SAndrey Konovalov #define kcov_debug(fmt, ...) pr_debug("%s: " fmt, __func__, ##__VA_ARGS__)
29eec028c9SAndrey Konovalov 
30ded97d2cSVictor Chibotaru /* Number of 64-bit words written per one comparison: */
31ded97d2cSVictor Chibotaru #define KCOV_WORDS_PER_CMP 4
32ded97d2cSVictor Chibotaru 
335c9a8750SDmitry Vyukov /*
345c9a8750SDmitry Vyukov  * kcov descriptor (one per opened debugfs file).
355c9a8750SDmitry Vyukov  * State transitions of the descriptor:
365c9a8750SDmitry Vyukov  *  - initial state after open()
375c9a8750SDmitry Vyukov  *  - then there must be a single ioctl(KCOV_INIT_TRACE) call
385c9a8750SDmitry Vyukov  *  - then, mmap() call (several calls are allowed but not useful)
39ded97d2cSVictor Chibotaru  *  - then, ioctl(KCOV_ENABLE, arg), where arg is
40ded97d2cSVictor Chibotaru  *	KCOV_TRACE_PC - to trace only the PCs
41ded97d2cSVictor Chibotaru  *	or
42ded97d2cSVictor Chibotaru  *	KCOV_TRACE_CMP - to trace only the comparison operands
43ded97d2cSVictor Chibotaru  *  - then, ioctl(KCOV_DISABLE) to disable the task.
44ded97d2cSVictor Chibotaru  * Enabling/disabling ioctls can be repeated (only one task a time allowed).
455c9a8750SDmitry Vyukov  */
465c9a8750SDmitry Vyukov struct kcov {
475c9a8750SDmitry Vyukov 	/*
485c9a8750SDmitry Vyukov 	 * Reference counter. We keep one for:
495c9a8750SDmitry Vyukov 	 *  - opened file descriptor
505c9a8750SDmitry Vyukov 	 *  - task with enabled coverage (we can't unwire it from another task)
51eec028c9SAndrey Konovalov 	 *  - each code section for remote coverage collection
525c9a8750SDmitry Vyukov 	 */
5339e07cb6SElena Reshetova 	refcount_t		refcount;
545c9a8750SDmitry Vyukov 	/* The lock protects mode, size, area and t. */
555c9a8750SDmitry Vyukov 	spinlock_t		lock;
565c9a8750SDmitry Vyukov 	enum kcov_mode		mode;
57eec028c9SAndrey Konovalov 	/* Size of arena (in long's). */
58eec028c9SAndrey Konovalov 	unsigned int		size;
595c9a8750SDmitry Vyukov 	/* Coverage buffer shared with user space. */
605c9a8750SDmitry Vyukov 	void			*area;
615c9a8750SDmitry Vyukov 	/* Task for which we collect coverage, or NULL. */
625c9a8750SDmitry Vyukov 	struct task_struct	*t;
63eec028c9SAndrey Konovalov 	/* Collecting coverage from remote (background) threads. */
64eec028c9SAndrey Konovalov 	bool			remote;
65eec028c9SAndrey Konovalov 	/* Size of remote area (in long's). */
66eec028c9SAndrey Konovalov 	unsigned int		remote_size;
67eec028c9SAndrey Konovalov 	/*
68eec028c9SAndrey Konovalov 	 * Sequence is incremented each time kcov is reenabled, used by
69eec028c9SAndrey Konovalov 	 * kcov_remote_stop(), see the comment there.
70eec028c9SAndrey Konovalov 	 */
71eec028c9SAndrey Konovalov 	int			sequence;
725c9a8750SDmitry Vyukov };
735c9a8750SDmitry Vyukov 
74eec028c9SAndrey Konovalov struct kcov_remote_area {
75eec028c9SAndrey Konovalov 	struct list_head	list;
76eec028c9SAndrey Konovalov 	unsigned int		size;
77eec028c9SAndrey Konovalov };
78eec028c9SAndrey Konovalov 
79eec028c9SAndrey Konovalov struct kcov_remote {
80eec028c9SAndrey Konovalov 	u64			handle;
81eec028c9SAndrey Konovalov 	struct kcov		*kcov;
82eec028c9SAndrey Konovalov 	struct hlist_node	hnode;
83eec028c9SAndrey Konovalov };
84eec028c9SAndrey Konovalov 
85eec028c9SAndrey Konovalov static DEFINE_SPINLOCK(kcov_remote_lock);
86eec028c9SAndrey Konovalov static DEFINE_HASHTABLE(kcov_remote_map, 4);
87eec028c9SAndrey Konovalov static struct list_head kcov_remote_areas = LIST_HEAD_INIT(kcov_remote_areas);
88eec028c9SAndrey Konovalov 
89eec028c9SAndrey Konovalov /* Must be called with kcov_remote_lock locked. */
90eec028c9SAndrey Konovalov static struct kcov_remote *kcov_remote_find(u64 handle)
91eec028c9SAndrey Konovalov {
92eec028c9SAndrey Konovalov 	struct kcov_remote *remote;
93eec028c9SAndrey Konovalov 
94eec028c9SAndrey Konovalov 	hash_for_each_possible(kcov_remote_map, remote, hnode, handle) {
95eec028c9SAndrey Konovalov 		if (remote->handle == handle)
96eec028c9SAndrey Konovalov 			return remote;
97eec028c9SAndrey Konovalov 	}
98eec028c9SAndrey Konovalov 	return NULL;
99eec028c9SAndrey Konovalov }
100eec028c9SAndrey Konovalov 
1013c61df38SAndrey Konovalov /* Must be called with kcov_remote_lock locked. */
102eec028c9SAndrey Konovalov static struct kcov_remote *kcov_remote_add(struct kcov *kcov, u64 handle)
103eec028c9SAndrey Konovalov {
104eec028c9SAndrey Konovalov 	struct kcov_remote *remote;
105eec028c9SAndrey Konovalov 
106eec028c9SAndrey Konovalov 	if (kcov_remote_find(handle))
107eec028c9SAndrey Konovalov 		return ERR_PTR(-EEXIST);
108eec028c9SAndrey Konovalov 	remote = kmalloc(sizeof(*remote), GFP_ATOMIC);
109eec028c9SAndrey Konovalov 	if (!remote)
110eec028c9SAndrey Konovalov 		return ERR_PTR(-ENOMEM);
111eec028c9SAndrey Konovalov 	remote->handle = handle;
112eec028c9SAndrey Konovalov 	remote->kcov = kcov;
113eec028c9SAndrey Konovalov 	hash_add(kcov_remote_map, &remote->hnode, handle);
114eec028c9SAndrey Konovalov 	return remote;
115eec028c9SAndrey Konovalov }
116eec028c9SAndrey Konovalov 
117eec028c9SAndrey Konovalov /* Must be called with kcov_remote_lock locked. */
118eec028c9SAndrey Konovalov static struct kcov_remote_area *kcov_remote_area_get(unsigned int size)
119eec028c9SAndrey Konovalov {
120eec028c9SAndrey Konovalov 	struct kcov_remote_area *area;
121eec028c9SAndrey Konovalov 	struct list_head *pos;
122eec028c9SAndrey Konovalov 
123eec028c9SAndrey Konovalov 	list_for_each(pos, &kcov_remote_areas) {
124eec028c9SAndrey Konovalov 		area = list_entry(pos, struct kcov_remote_area, list);
125eec028c9SAndrey Konovalov 		if (area->size == size) {
126eec028c9SAndrey Konovalov 			list_del(&area->list);
127eec028c9SAndrey Konovalov 			return area;
128eec028c9SAndrey Konovalov 		}
129eec028c9SAndrey Konovalov 	}
130eec028c9SAndrey Konovalov 	return NULL;
131eec028c9SAndrey Konovalov }
132eec028c9SAndrey Konovalov 
133eec028c9SAndrey Konovalov /* Must be called with kcov_remote_lock locked. */
134eec028c9SAndrey Konovalov static void kcov_remote_area_put(struct kcov_remote_area *area,
135eec028c9SAndrey Konovalov 					unsigned int size)
136eec028c9SAndrey Konovalov {
137eec028c9SAndrey Konovalov 	INIT_LIST_HEAD(&area->list);
138eec028c9SAndrey Konovalov 	area->size = size;
139eec028c9SAndrey Konovalov 	list_add(&area->list, &kcov_remote_areas);
140eec028c9SAndrey Konovalov }
141eec028c9SAndrey Konovalov 
142903e8ff8SAnders Roxell static notrace bool check_kcov_mode(enum kcov_mode needed_mode, struct task_struct *t)
1435c9a8750SDmitry Vyukov {
1440ed557aaSMark Rutland 	unsigned int mode;
1455c9a8750SDmitry Vyukov 
1465c9a8750SDmitry Vyukov 	/*
1475c9a8750SDmitry Vyukov 	 * We are interested in code coverage as a function of a syscall inputs,
1485c9a8750SDmitry Vyukov 	 * so we ignore code executed in interrupts.
1495c9a8750SDmitry Vyukov 	 */
150fcf4edacSAndrey Ryabinin 	if (!in_task())
151ded97d2cSVictor Chibotaru 		return false;
1525c9a8750SDmitry Vyukov 	mode = READ_ONCE(t->kcov_mode);
1535c9a8750SDmitry Vyukov 	/*
1545c9a8750SDmitry Vyukov 	 * There is some code that runs in interrupts but for which
1555c9a8750SDmitry Vyukov 	 * in_interrupt() returns false (e.g. preempt_schedule_irq()).
1565c9a8750SDmitry Vyukov 	 * READ_ONCE()/barrier() effectively provides load-acquire wrt
1575c9a8750SDmitry Vyukov 	 * interrupts, there are paired barrier()/WRITE_ONCE() in
158eec028c9SAndrey Konovalov 	 * kcov_start().
1595c9a8750SDmitry Vyukov 	 */
1605c9a8750SDmitry Vyukov 	barrier();
161ded97d2cSVictor Chibotaru 	return mode == needed_mode;
162ded97d2cSVictor Chibotaru }
163ded97d2cSVictor Chibotaru 
164903e8ff8SAnders Roxell static notrace unsigned long canonicalize_ip(unsigned long ip)
165ded97d2cSVictor Chibotaru {
166ded97d2cSVictor Chibotaru #ifdef CONFIG_RANDOMIZE_BASE
167ded97d2cSVictor Chibotaru 	ip -= kaslr_offset();
168ded97d2cSVictor Chibotaru #endif
169ded97d2cSVictor Chibotaru 	return ip;
170ded97d2cSVictor Chibotaru }
171ded97d2cSVictor Chibotaru 
172ded97d2cSVictor Chibotaru /*
173ded97d2cSVictor Chibotaru  * Entry point from instrumented code.
174ded97d2cSVictor Chibotaru  * This is called once per basic-block/edge.
175ded97d2cSVictor Chibotaru  */
176ded97d2cSVictor Chibotaru void notrace __sanitizer_cov_trace_pc(void)
177ded97d2cSVictor Chibotaru {
178ded97d2cSVictor Chibotaru 	struct task_struct *t;
179ded97d2cSVictor Chibotaru 	unsigned long *area;
180ded97d2cSVictor Chibotaru 	unsigned long ip = canonicalize_ip(_RET_IP_);
181ded97d2cSVictor Chibotaru 	unsigned long pos;
182ded97d2cSVictor Chibotaru 
183ded97d2cSVictor Chibotaru 	t = current;
184ded97d2cSVictor Chibotaru 	if (!check_kcov_mode(KCOV_MODE_TRACE_PC, t))
185ded97d2cSVictor Chibotaru 		return;
186ded97d2cSVictor Chibotaru 
1875c9a8750SDmitry Vyukov 	area = t->kcov_area;
188ded97d2cSVictor Chibotaru 	/* The first 64-bit word is the number of subsequent PCs. */
1895c9a8750SDmitry Vyukov 	pos = READ_ONCE(area[0]) + 1;
1905c9a8750SDmitry Vyukov 	if (likely(pos < t->kcov_size)) {
1914983f0abSAlexander Popov 		area[pos] = ip;
1925c9a8750SDmitry Vyukov 		WRITE_ONCE(area[0], pos);
1935c9a8750SDmitry Vyukov 	}
1945c9a8750SDmitry Vyukov }
1955c9a8750SDmitry Vyukov EXPORT_SYMBOL(__sanitizer_cov_trace_pc);
1965c9a8750SDmitry Vyukov 
197ded97d2cSVictor Chibotaru #ifdef CONFIG_KCOV_ENABLE_COMPARISONS
19863472443SAnders Roxell static void notrace write_comp_data(u64 type, u64 arg1, u64 arg2, u64 ip)
199ded97d2cSVictor Chibotaru {
200ded97d2cSVictor Chibotaru 	struct task_struct *t;
201ded97d2cSVictor Chibotaru 	u64 *area;
202ded97d2cSVictor Chibotaru 	u64 count, start_index, end_pos, max_pos;
203ded97d2cSVictor Chibotaru 
204ded97d2cSVictor Chibotaru 	t = current;
205ded97d2cSVictor Chibotaru 	if (!check_kcov_mode(KCOV_MODE_TRACE_CMP, t))
206ded97d2cSVictor Chibotaru 		return;
207ded97d2cSVictor Chibotaru 
208ded97d2cSVictor Chibotaru 	ip = canonicalize_ip(ip);
209ded97d2cSVictor Chibotaru 
210ded97d2cSVictor Chibotaru 	/*
211ded97d2cSVictor Chibotaru 	 * We write all comparison arguments and types as u64.
212ded97d2cSVictor Chibotaru 	 * The buffer was allocated for t->kcov_size unsigned longs.
213ded97d2cSVictor Chibotaru 	 */
214ded97d2cSVictor Chibotaru 	area = (u64 *)t->kcov_area;
215ded97d2cSVictor Chibotaru 	max_pos = t->kcov_size * sizeof(unsigned long);
216ded97d2cSVictor Chibotaru 
217ded97d2cSVictor Chibotaru 	count = READ_ONCE(area[0]);
218ded97d2cSVictor Chibotaru 
219ded97d2cSVictor Chibotaru 	/* Every record is KCOV_WORDS_PER_CMP 64-bit words. */
220ded97d2cSVictor Chibotaru 	start_index = 1 + count * KCOV_WORDS_PER_CMP;
221ded97d2cSVictor Chibotaru 	end_pos = (start_index + KCOV_WORDS_PER_CMP) * sizeof(u64);
222ded97d2cSVictor Chibotaru 	if (likely(end_pos <= max_pos)) {
223ded97d2cSVictor Chibotaru 		area[start_index] = type;
224ded97d2cSVictor Chibotaru 		area[start_index + 1] = arg1;
225ded97d2cSVictor Chibotaru 		area[start_index + 2] = arg2;
226ded97d2cSVictor Chibotaru 		area[start_index + 3] = ip;
227ded97d2cSVictor Chibotaru 		WRITE_ONCE(area[0], count + 1);
228ded97d2cSVictor Chibotaru 	}
229ded97d2cSVictor Chibotaru }
230ded97d2cSVictor Chibotaru 
231ded97d2cSVictor Chibotaru void notrace __sanitizer_cov_trace_cmp1(u8 arg1, u8 arg2)
232ded97d2cSVictor Chibotaru {
233ded97d2cSVictor Chibotaru 	write_comp_data(KCOV_CMP_SIZE(0), arg1, arg2, _RET_IP_);
234ded97d2cSVictor Chibotaru }
235ded97d2cSVictor Chibotaru EXPORT_SYMBOL(__sanitizer_cov_trace_cmp1);
236ded97d2cSVictor Chibotaru 
237ded97d2cSVictor Chibotaru void notrace __sanitizer_cov_trace_cmp2(u16 arg1, u16 arg2)
238ded97d2cSVictor Chibotaru {
239ded97d2cSVictor Chibotaru 	write_comp_data(KCOV_CMP_SIZE(1), arg1, arg2, _RET_IP_);
240ded97d2cSVictor Chibotaru }
241ded97d2cSVictor Chibotaru EXPORT_SYMBOL(__sanitizer_cov_trace_cmp2);
242ded97d2cSVictor Chibotaru 
243689d77f0SDmitry Vyukov void notrace __sanitizer_cov_trace_cmp4(u32 arg1, u32 arg2)
244ded97d2cSVictor Chibotaru {
245ded97d2cSVictor Chibotaru 	write_comp_data(KCOV_CMP_SIZE(2), arg1, arg2, _RET_IP_);
246ded97d2cSVictor Chibotaru }
247ded97d2cSVictor Chibotaru EXPORT_SYMBOL(__sanitizer_cov_trace_cmp4);
248ded97d2cSVictor Chibotaru 
249ded97d2cSVictor Chibotaru void notrace __sanitizer_cov_trace_cmp8(u64 arg1, u64 arg2)
250ded97d2cSVictor Chibotaru {
251ded97d2cSVictor Chibotaru 	write_comp_data(KCOV_CMP_SIZE(3), arg1, arg2, _RET_IP_);
252ded97d2cSVictor Chibotaru }
253ded97d2cSVictor Chibotaru EXPORT_SYMBOL(__sanitizer_cov_trace_cmp8);
254ded97d2cSVictor Chibotaru 
255ded97d2cSVictor Chibotaru void notrace __sanitizer_cov_trace_const_cmp1(u8 arg1, u8 arg2)
256ded97d2cSVictor Chibotaru {
257ded97d2cSVictor Chibotaru 	write_comp_data(KCOV_CMP_SIZE(0) | KCOV_CMP_CONST, arg1, arg2,
258ded97d2cSVictor Chibotaru 			_RET_IP_);
259ded97d2cSVictor Chibotaru }
260ded97d2cSVictor Chibotaru EXPORT_SYMBOL(__sanitizer_cov_trace_const_cmp1);
261ded97d2cSVictor Chibotaru 
262ded97d2cSVictor Chibotaru void notrace __sanitizer_cov_trace_const_cmp2(u16 arg1, u16 arg2)
263ded97d2cSVictor Chibotaru {
264ded97d2cSVictor Chibotaru 	write_comp_data(KCOV_CMP_SIZE(1) | KCOV_CMP_CONST, arg1, arg2,
265ded97d2cSVictor Chibotaru 			_RET_IP_);
266ded97d2cSVictor Chibotaru }
267ded97d2cSVictor Chibotaru EXPORT_SYMBOL(__sanitizer_cov_trace_const_cmp2);
268ded97d2cSVictor Chibotaru 
269689d77f0SDmitry Vyukov void notrace __sanitizer_cov_trace_const_cmp4(u32 arg1, u32 arg2)
270ded97d2cSVictor Chibotaru {
271ded97d2cSVictor Chibotaru 	write_comp_data(KCOV_CMP_SIZE(2) | KCOV_CMP_CONST, arg1, arg2,
272ded97d2cSVictor Chibotaru 			_RET_IP_);
273ded97d2cSVictor Chibotaru }
274ded97d2cSVictor Chibotaru EXPORT_SYMBOL(__sanitizer_cov_trace_const_cmp4);
275ded97d2cSVictor Chibotaru 
276ded97d2cSVictor Chibotaru void notrace __sanitizer_cov_trace_const_cmp8(u64 arg1, u64 arg2)
277ded97d2cSVictor Chibotaru {
278ded97d2cSVictor Chibotaru 	write_comp_data(KCOV_CMP_SIZE(3) | KCOV_CMP_CONST, arg1, arg2,
279ded97d2cSVictor Chibotaru 			_RET_IP_);
280ded97d2cSVictor Chibotaru }
281ded97d2cSVictor Chibotaru EXPORT_SYMBOL(__sanitizer_cov_trace_const_cmp8);
282ded97d2cSVictor Chibotaru 
283ded97d2cSVictor Chibotaru void notrace __sanitizer_cov_trace_switch(u64 val, u64 *cases)
284ded97d2cSVictor Chibotaru {
285ded97d2cSVictor Chibotaru 	u64 i;
286ded97d2cSVictor Chibotaru 	u64 count = cases[0];
287ded97d2cSVictor Chibotaru 	u64 size = cases[1];
288ded97d2cSVictor Chibotaru 	u64 type = KCOV_CMP_CONST;
289ded97d2cSVictor Chibotaru 
290ded97d2cSVictor Chibotaru 	switch (size) {
291ded97d2cSVictor Chibotaru 	case 8:
292ded97d2cSVictor Chibotaru 		type |= KCOV_CMP_SIZE(0);
293ded97d2cSVictor Chibotaru 		break;
294ded97d2cSVictor Chibotaru 	case 16:
295ded97d2cSVictor Chibotaru 		type |= KCOV_CMP_SIZE(1);
296ded97d2cSVictor Chibotaru 		break;
297ded97d2cSVictor Chibotaru 	case 32:
298ded97d2cSVictor Chibotaru 		type |= KCOV_CMP_SIZE(2);
299ded97d2cSVictor Chibotaru 		break;
300ded97d2cSVictor Chibotaru 	case 64:
301ded97d2cSVictor Chibotaru 		type |= KCOV_CMP_SIZE(3);
302ded97d2cSVictor Chibotaru 		break;
303ded97d2cSVictor Chibotaru 	default:
304ded97d2cSVictor Chibotaru 		return;
305ded97d2cSVictor Chibotaru 	}
306ded97d2cSVictor Chibotaru 	for (i = 0; i < count; i++)
307ded97d2cSVictor Chibotaru 		write_comp_data(type, cases[i + 2], val, _RET_IP_);
308ded97d2cSVictor Chibotaru }
309ded97d2cSVictor Chibotaru EXPORT_SYMBOL(__sanitizer_cov_trace_switch);
310ded97d2cSVictor Chibotaru #endif /* ifdef CONFIG_KCOV_ENABLE_COMPARISONS */
311ded97d2cSVictor Chibotaru 
312eec028c9SAndrey Konovalov static void kcov_start(struct task_struct *t, unsigned int size,
313eec028c9SAndrey Konovalov 			void *area, enum kcov_mode mode, int sequence)
314eec028c9SAndrey Konovalov {
315eec028c9SAndrey Konovalov 	kcov_debug("t = %px, size = %u, area = %px\n", t, size, area);
316eec028c9SAndrey Konovalov 	/* Cache in task struct for performance. */
317eec028c9SAndrey Konovalov 	t->kcov_size = size;
318eec028c9SAndrey Konovalov 	t->kcov_area = area;
319eec028c9SAndrey Konovalov 	/* See comment in check_kcov_mode(). */
320eec028c9SAndrey Konovalov 	barrier();
321eec028c9SAndrey Konovalov 	WRITE_ONCE(t->kcov_mode, mode);
322eec028c9SAndrey Konovalov 	t->kcov_sequence = sequence;
323eec028c9SAndrey Konovalov }
324eec028c9SAndrey Konovalov 
325eec028c9SAndrey Konovalov static void kcov_stop(struct task_struct *t)
326eec028c9SAndrey Konovalov {
327eec028c9SAndrey Konovalov 	WRITE_ONCE(t->kcov_mode, KCOV_MODE_DISABLED);
328eec028c9SAndrey Konovalov 	barrier();
329eec028c9SAndrey Konovalov 	t->kcov_size = 0;
330eec028c9SAndrey Konovalov 	t->kcov_area = NULL;
331eec028c9SAndrey Konovalov }
332eec028c9SAndrey Konovalov 
333eec028c9SAndrey Konovalov static void kcov_task_reset(struct task_struct *t)
334eec028c9SAndrey Konovalov {
335eec028c9SAndrey Konovalov 	kcov_stop(t);
336eec028c9SAndrey Konovalov 	t->kcov = NULL;
337eec028c9SAndrey Konovalov 	t->kcov_sequence = 0;
338eec028c9SAndrey Konovalov 	t->kcov_handle = 0;
339eec028c9SAndrey Konovalov }
340eec028c9SAndrey Konovalov 
341eec028c9SAndrey Konovalov void kcov_task_init(struct task_struct *t)
342eec028c9SAndrey Konovalov {
343eec028c9SAndrey Konovalov 	kcov_task_reset(t);
344eec028c9SAndrey Konovalov 	t->kcov_handle = current->kcov_handle;
345eec028c9SAndrey Konovalov }
346eec028c9SAndrey Konovalov 
347eec028c9SAndrey Konovalov static void kcov_reset(struct kcov *kcov)
348eec028c9SAndrey Konovalov {
349eec028c9SAndrey Konovalov 	kcov->t = NULL;
350eec028c9SAndrey Konovalov 	kcov->mode = KCOV_MODE_INIT;
351eec028c9SAndrey Konovalov 	kcov->remote = false;
352eec028c9SAndrey Konovalov 	kcov->remote_size = 0;
353eec028c9SAndrey Konovalov 	kcov->sequence++;
354eec028c9SAndrey Konovalov }
355eec028c9SAndrey Konovalov 
356eec028c9SAndrey Konovalov static void kcov_remote_reset(struct kcov *kcov)
357eec028c9SAndrey Konovalov {
358eec028c9SAndrey Konovalov 	int bkt;
359eec028c9SAndrey Konovalov 	struct kcov_remote *remote;
360eec028c9SAndrey Konovalov 	struct hlist_node *tmp;
361eec028c9SAndrey Konovalov 
362eec028c9SAndrey Konovalov 	spin_lock(&kcov_remote_lock);
363eec028c9SAndrey Konovalov 	hash_for_each_safe(kcov_remote_map, bkt, tmp, remote, hnode) {
364eec028c9SAndrey Konovalov 		if (remote->kcov != kcov)
365eec028c9SAndrey Konovalov 			continue;
366eec028c9SAndrey Konovalov 		hash_del(&remote->hnode);
367eec028c9SAndrey Konovalov 		kfree(remote);
368eec028c9SAndrey Konovalov 	}
369eec028c9SAndrey Konovalov 	/* Do reset before unlock to prevent races with kcov_remote_start(). */
370eec028c9SAndrey Konovalov 	kcov_reset(kcov);
371eec028c9SAndrey Konovalov 	spin_unlock(&kcov_remote_lock);
372eec028c9SAndrey Konovalov }
373eec028c9SAndrey Konovalov 
374eec028c9SAndrey Konovalov static void kcov_disable(struct task_struct *t, struct kcov *kcov)
375eec028c9SAndrey Konovalov {
376eec028c9SAndrey Konovalov 	kcov_task_reset(t);
377eec028c9SAndrey Konovalov 	if (kcov->remote)
378eec028c9SAndrey Konovalov 		kcov_remote_reset(kcov);
379eec028c9SAndrey Konovalov 	else
380eec028c9SAndrey Konovalov 		kcov_reset(kcov);
381eec028c9SAndrey Konovalov }
382eec028c9SAndrey Konovalov 
3835c9a8750SDmitry Vyukov static void kcov_get(struct kcov *kcov)
3845c9a8750SDmitry Vyukov {
38539e07cb6SElena Reshetova 	refcount_inc(&kcov->refcount);
3865c9a8750SDmitry Vyukov }
3875c9a8750SDmitry Vyukov 
3885c9a8750SDmitry Vyukov static void kcov_put(struct kcov *kcov)
3895c9a8750SDmitry Vyukov {
39039e07cb6SElena Reshetova 	if (refcount_dec_and_test(&kcov->refcount)) {
391eec028c9SAndrey Konovalov 		kcov_remote_reset(kcov);
3925c9a8750SDmitry Vyukov 		vfree(kcov->area);
3935c9a8750SDmitry Vyukov 		kfree(kcov);
3945c9a8750SDmitry Vyukov 	}
3955c9a8750SDmitry Vyukov }
3965c9a8750SDmitry Vyukov 
3975c9a8750SDmitry Vyukov void kcov_task_exit(struct task_struct *t)
3985c9a8750SDmitry Vyukov {
3995c9a8750SDmitry Vyukov 	struct kcov *kcov;
4005c9a8750SDmitry Vyukov 
4015c9a8750SDmitry Vyukov 	kcov = t->kcov;
4025c9a8750SDmitry Vyukov 	if (kcov == NULL)
4035c9a8750SDmitry Vyukov 		return;
404eec028c9SAndrey Konovalov 
4055c9a8750SDmitry Vyukov 	spin_lock(&kcov->lock);
406eec028c9SAndrey Konovalov 	kcov_debug("t = %px, kcov->t = %px\n", t, kcov->t);
407eec028c9SAndrey Konovalov 	/*
408eec028c9SAndrey Konovalov 	 * For KCOV_ENABLE devices we want to make sure that t->kcov->t == t,
409eec028c9SAndrey Konovalov 	 * which comes down to:
410eec028c9SAndrey Konovalov 	 *        WARN_ON(!kcov->remote && kcov->t != t);
411eec028c9SAndrey Konovalov 	 *
412eec028c9SAndrey Konovalov 	 * For KCOV_REMOTE_ENABLE devices, the exiting task is either:
413eec028c9SAndrey Konovalov 	 * 2. A remote task between kcov_remote_start() and kcov_remote_stop().
414eec028c9SAndrey Konovalov 	 *    In this case we should print a warning right away, since a task
415eec028c9SAndrey Konovalov 	 *    shouldn't be exiting when it's in a kcov coverage collection
416eec028c9SAndrey Konovalov 	 *    section. Here t points to the task that is collecting remote
417eec028c9SAndrey Konovalov 	 *    coverage, and t->kcov->t points to the thread that created the
418eec028c9SAndrey Konovalov 	 *    kcov device. Which means that to detect this case we need to
419eec028c9SAndrey Konovalov 	 *    check that t != t->kcov->t, and this gives us the following:
420eec028c9SAndrey Konovalov 	 *        WARN_ON(kcov->remote && kcov->t != t);
421eec028c9SAndrey Konovalov 	 *
422eec028c9SAndrey Konovalov 	 * 2. The task that created kcov exiting without calling KCOV_DISABLE,
423eec028c9SAndrey Konovalov 	 *    and then again we can make sure that t->kcov->t == t:
424eec028c9SAndrey Konovalov 	 *        WARN_ON(kcov->remote && kcov->t != t);
425eec028c9SAndrey Konovalov 	 *
426eec028c9SAndrey Konovalov 	 * By combining all three checks into one we get:
427eec028c9SAndrey Konovalov 	 */
4285c9a8750SDmitry Vyukov 	if (WARN_ON(kcov->t != t)) {
4295c9a8750SDmitry Vyukov 		spin_unlock(&kcov->lock);
4305c9a8750SDmitry Vyukov 		return;
4315c9a8750SDmitry Vyukov 	}
4325c9a8750SDmitry Vyukov 	/* Just to not leave dangling references behind. */
433eec028c9SAndrey Konovalov 	kcov_disable(t, kcov);
4345c9a8750SDmitry Vyukov 	spin_unlock(&kcov->lock);
4355c9a8750SDmitry Vyukov 	kcov_put(kcov);
4365c9a8750SDmitry Vyukov }
4375c9a8750SDmitry Vyukov 
4385c9a8750SDmitry Vyukov static int kcov_mmap(struct file *filep, struct vm_area_struct *vma)
4395c9a8750SDmitry Vyukov {
4405c9a8750SDmitry Vyukov 	int res = 0;
4415c9a8750SDmitry Vyukov 	void *area;
4425c9a8750SDmitry Vyukov 	struct kcov *kcov = vma->vm_file->private_data;
4435c9a8750SDmitry Vyukov 	unsigned long size, off;
4445c9a8750SDmitry Vyukov 	struct page *page;
4455c9a8750SDmitry Vyukov 
4465c9a8750SDmitry Vyukov 	area = vmalloc_user(vma->vm_end - vma->vm_start);
4475c9a8750SDmitry Vyukov 	if (!area)
4485c9a8750SDmitry Vyukov 		return -ENOMEM;
4495c9a8750SDmitry Vyukov 
4505c9a8750SDmitry Vyukov 	spin_lock(&kcov->lock);
4515c9a8750SDmitry Vyukov 	size = kcov->size * sizeof(unsigned long);
452ded97d2cSVictor Chibotaru 	if (kcov->mode != KCOV_MODE_INIT || vma->vm_pgoff != 0 ||
4535c9a8750SDmitry Vyukov 	    vma->vm_end - vma->vm_start != size) {
4545c9a8750SDmitry Vyukov 		res = -EINVAL;
4555c9a8750SDmitry Vyukov 		goto exit;
4565c9a8750SDmitry Vyukov 	}
4575c9a8750SDmitry Vyukov 	if (!kcov->area) {
4585c9a8750SDmitry Vyukov 		kcov->area = area;
4595c9a8750SDmitry Vyukov 		vma->vm_flags |= VM_DONTEXPAND;
4605c9a8750SDmitry Vyukov 		spin_unlock(&kcov->lock);
4615c9a8750SDmitry Vyukov 		for (off = 0; off < size; off += PAGE_SIZE) {
4625c9a8750SDmitry Vyukov 			page = vmalloc_to_page(kcov->area + off);
4635c9a8750SDmitry Vyukov 			if (vm_insert_page(vma, vma->vm_start + off, page))
4645c9a8750SDmitry Vyukov 				WARN_ONCE(1, "vm_insert_page() failed");
4655c9a8750SDmitry Vyukov 		}
4665c9a8750SDmitry Vyukov 		return 0;
4675c9a8750SDmitry Vyukov 	}
4685c9a8750SDmitry Vyukov exit:
4695c9a8750SDmitry Vyukov 	spin_unlock(&kcov->lock);
4705c9a8750SDmitry Vyukov 	vfree(area);
4715c9a8750SDmitry Vyukov 	return res;
4725c9a8750SDmitry Vyukov }
4735c9a8750SDmitry Vyukov 
4745c9a8750SDmitry Vyukov static int kcov_open(struct inode *inode, struct file *filep)
4755c9a8750SDmitry Vyukov {
4765c9a8750SDmitry Vyukov 	struct kcov *kcov;
4775c9a8750SDmitry Vyukov 
4785c9a8750SDmitry Vyukov 	kcov = kzalloc(sizeof(*kcov), GFP_KERNEL);
4795c9a8750SDmitry Vyukov 	if (!kcov)
4805c9a8750SDmitry Vyukov 		return -ENOMEM;
481ded97d2cSVictor Chibotaru 	kcov->mode = KCOV_MODE_DISABLED;
482eec028c9SAndrey Konovalov 	kcov->sequence = 1;
48339e07cb6SElena Reshetova 	refcount_set(&kcov->refcount, 1);
4845c9a8750SDmitry Vyukov 	spin_lock_init(&kcov->lock);
4855c9a8750SDmitry Vyukov 	filep->private_data = kcov;
4865c9a8750SDmitry Vyukov 	return nonseekable_open(inode, filep);
4875c9a8750SDmitry Vyukov }
4885c9a8750SDmitry Vyukov 
4895c9a8750SDmitry Vyukov static int kcov_close(struct inode *inode, struct file *filep)
4905c9a8750SDmitry Vyukov {
4915c9a8750SDmitry Vyukov 	kcov_put(filep->private_data);
4925c9a8750SDmitry Vyukov 	return 0;
4935c9a8750SDmitry Vyukov }
4945c9a8750SDmitry Vyukov 
495eec028c9SAndrey Konovalov static int kcov_get_mode(unsigned long arg)
496eec028c9SAndrey Konovalov {
497eec028c9SAndrey Konovalov 	if (arg == KCOV_TRACE_PC)
498eec028c9SAndrey Konovalov 		return KCOV_MODE_TRACE_PC;
499eec028c9SAndrey Konovalov 	else if (arg == KCOV_TRACE_CMP)
500eec028c9SAndrey Konovalov #ifdef CONFIG_KCOV_ENABLE_COMPARISONS
501eec028c9SAndrey Konovalov 		return KCOV_MODE_TRACE_CMP;
502eec028c9SAndrey Konovalov #else
503eec028c9SAndrey Konovalov 		return -ENOTSUPP;
504eec028c9SAndrey Konovalov #endif
505eec028c9SAndrey Konovalov 	else
506eec028c9SAndrey Konovalov 		return -EINVAL;
507eec028c9SAndrey Konovalov }
508eec028c9SAndrey Konovalov 
509dc55daffSMark Rutland /*
510dc55daffSMark Rutland  * Fault in a lazily-faulted vmalloc area before it can be used by
511dc55daffSMark Rutland  * __santizer_cov_trace_pc(), to avoid recursion issues if any code on the
512dc55daffSMark Rutland  * vmalloc fault handling path is instrumented.
513dc55daffSMark Rutland  */
514dc55daffSMark Rutland static void kcov_fault_in_area(struct kcov *kcov)
515dc55daffSMark Rutland {
516dc55daffSMark Rutland 	unsigned long stride = PAGE_SIZE / sizeof(unsigned long);
517dc55daffSMark Rutland 	unsigned long *area = kcov->area;
518dc55daffSMark Rutland 	unsigned long offset;
519dc55daffSMark Rutland 
520dc55daffSMark Rutland 	for (offset = 0; offset < kcov->size; offset += stride)
521dc55daffSMark Rutland 		READ_ONCE(area[offset]);
522dc55daffSMark Rutland }
523dc55daffSMark Rutland 
524eec028c9SAndrey Konovalov static inline bool kcov_check_handle(u64 handle, bool common_valid,
525eec028c9SAndrey Konovalov 				bool uncommon_valid, bool zero_valid)
526eec028c9SAndrey Konovalov {
527eec028c9SAndrey Konovalov 	if (handle & ~(KCOV_SUBSYSTEM_MASK | KCOV_INSTANCE_MASK))
528eec028c9SAndrey Konovalov 		return false;
529eec028c9SAndrey Konovalov 	switch (handle & KCOV_SUBSYSTEM_MASK) {
530eec028c9SAndrey Konovalov 	case KCOV_SUBSYSTEM_COMMON:
531eec028c9SAndrey Konovalov 		return (handle & KCOV_INSTANCE_MASK) ?
532eec028c9SAndrey Konovalov 			common_valid : zero_valid;
533eec028c9SAndrey Konovalov 	case KCOV_SUBSYSTEM_USB:
534eec028c9SAndrey Konovalov 		return uncommon_valid;
535eec028c9SAndrey Konovalov 	default:
536eec028c9SAndrey Konovalov 		return false;
537eec028c9SAndrey Konovalov 	}
538eec028c9SAndrey Konovalov 	return false;
539eec028c9SAndrey Konovalov }
540eec028c9SAndrey Konovalov 
5415c9a8750SDmitry Vyukov static int kcov_ioctl_locked(struct kcov *kcov, unsigned int cmd,
5425c9a8750SDmitry Vyukov 			     unsigned long arg)
5435c9a8750SDmitry Vyukov {
5445c9a8750SDmitry Vyukov 	struct task_struct *t;
5455c9a8750SDmitry Vyukov 	unsigned long size, unused;
546eec028c9SAndrey Konovalov 	int mode, i;
547eec028c9SAndrey Konovalov 	struct kcov_remote_arg *remote_arg;
548eec028c9SAndrey Konovalov 	struct kcov_remote *remote;
5495c9a8750SDmitry Vyukov 
5505c9a8750SDmitry Vyukov 	switch (cmd) {
5515c9a8750SDmitry Vyukov 	case KCOV_INIT_TRACE:
5525c9a8750SDmitry Vyukov 		/*
5535c9a8750SDmitry Vyukov 		 * Enable kcov in trace mode and setup buffer size.
5545c9a8750SDmitry Vyukov 		 * Must happen before anything else.
5555c9a8750SDmitry Vyukov 		 */
5565c9a8750SDmitry Vyukov 		if (kcov->mode != KCOV_MODE_DISABLED)
5575c9a8750SDmitry Vyukov 			return -EBUSY;
5585c9a8750SDmitry Vyukov 		/*
5595c9a8750SDmitry Vyukov 		 * Size must be at least 2 to hold current position and one PC.
5605c9a8750SDmitry Vyukov 		 * Later we allocate size * sizeof(unsigned long) memory,
5615c9a8750SDmitry Vyukov 		 * that must not overflow.
5625c9a8750SDmitry Vyukov 		 */
5635c9a8750SDmitry Vyukov 		size = arg;
5645c9a8750SDmitry Vyukov 		if (size < 2 || size > INT_MAX / sizeof(unsigned long))
5655c9a8750SDmitry Vyukov 			return -EINVAL;
5665c9a8750SDmitry Vyukov 		kcov->size = size;
567ded97d2cSVictor Chibotaru 		kcov->mode = KCOV_MODE_INIT;
5685c9a8750SDmitry Vyukov 		return 0;
5695c9a8750SDmitry Vyukov 	case KCOV_ENABLE:
5705c9a8750SDmitry Vyukov 		/*
5715c9a8750SDmitry Vyukov 		 * Enable coverage for the current task.
5725c9a8750SDmitry Vyukov 		 * At this point user must have been enabled trace mode,
5735c9a8750SDmitry Vyukov 		 * and mmapped the file. Coverage collection is disabled only
5745c9a8750SDmitry Vyukov 		 * at task exit or voluntary by KCOV_DISABLE. After that it can
5755c9a8750SDmitry Vyukov 		 * be enabled for another task.
5765c9a8750SDmitry Vyukov 		 */
577ded97d2cSVictor Chibotaru 		if (kcov->mode != KCOV_MODE_INIT || !kcov->area)
5785c9a8750SDmitry Vyukov 			return -EINVAL;
579a77660d2SDmitry Vyukov 		t = current;
580a77660d2SDmitry Vyukov 		if (kcov->t != NULL || t->kcov != NULL)
5815c9a8750SDmitry Vyukov 			return -EBUSY;
582eec028c9SAndrey Konovalov 		mode = kcov_get_mode(arg);
583eec028c9SAndrey Konovalov 		if (mode < 0)
584eec028c9SAndrey Konovalov 			return mode;
585dc55daffSMark Rutland 		kcov_fault_in_area(kcov);
586eec028c9SAndrey Konovalov 		kcov->mode = mode;
587eec028c9SAndrey Konovalov 		kcov_start(t, kcov->size, kcov->area, kcov->mode,
588eec028c9SAndrey Konovalov 				kcov->sequence);
5895c9a8750SDmitry Vyukov 		t->kcov = kcov;
5905c9a8750SDmitry Vyukov 		kcov->t = t;
591eec028c9SAndrey Konovalov 		/* Put either in kcov_task_exit() or in KCOV_DISABLE. */
5925c9a8750SDmitry Vyukov 		kcov_get(kcov);
5935c9a8750SDmitry Vyukov 		return 0;
5945c9a8750SDmitry Vyukov 	case KCOV_DISABLE:
5955c9a8750SDmitry Vyukov 		/* Disable coverage for the current task. */
5965c9a8750SDmitry Vyukov 		unused = arg;
5975c9a8750SDmitry Vyukov 		if (unused != 0 || current->kcov != kcov)
5985c9a8750SDmitry Vyukov 			return -EINVAL;
5995c9a8750SDmitry Vyukov 		t = current;
6005c9a8750SDmitry Vyukov 		if (WARN_ON(kcov->t != t))
6015c9a8750SDmitry Vyukov 			return -EINVAL;
602eec028c9SAndrey Konovalov 		kcov_disable(t, kcov);
6035c9a8750SDmitry Vyukov 		kcov_put(kcov);
6045c9a8750SDmitry Vyukov 		return 0;
605eec028c9SAndrey Konovalov 	case KCOV_REMOTE_ENABLE:
606eec028c9SAndrey Konovalov 		if (kcov->mode != KCOV_MODE_INIT || !kcov->area)
607eec028c9SAndrey Konovalov 			return -EINVAL;
608eec028c9SAndrey Konovalov 		t = current;
609eec028c9SAndrey Konovalov 		if (kcov->t != NULL || t->kcov != NULL)
610eec028c9SAndrey Konovalov 			return -EBUSY;
611eec028c9SAndrey Konovalov 		remote_arg = (struct kcov_remote_arg *)arg;
612eec028c9SAndrey Konovalov 		mode = kcov_get_mode(remote_arg->trace_mode);
613eec028c9SAndrey Konovalov 		if (mode < 0)
614eec028c9SAndrey Konovalov 			return mode;
615eec028c9SAndrey Konovalov 		if (remote_arg->area_size > LONG_MAX / sizeof(unsigned long))
616eec028c9SAndrey Konovalov 			return -EINVAL;
617eec028c9SAndrey Konovalov 		kcov->mode = mode;
618eec028c9SAndrey Konovalov 		t->kcov = kcov;
619eec028c9SAndrey Konovalov 		kcov->t = t;
620eec028c9SAndrey Konovalov 		kcov->remote = true;
621eec028c9SAndrey Konovalov 		kcov->remote_size = remote_arg->area_size;
622eec028c9SAndrey Konovalov 		spin_lock(&kcov_remote_lock);
623eec028c9SAndrey Konovalov 		for (i = 0; i < remote_arg->num_handles; i++) {
624eec028c9SAndrey Konovalov 			if (!kcov_check_handle(remote_arg->handles[i],
625eec028c9SAndrey Konovalov 						false, true, false)) {
626eec028c9SAndrey Konovalov 				spin_unlock(&kcov_remote_lock);
627eec028c9SAndrey Konovalov 				kcov_disable(t, kcov);
628eec028c9SAndrey Konovalov 				return -EINVAL;
629eec028c9SAndrey Konovalov 			}
630eec028c9SAndrey Konovalov 			remote = kcov_remote_add(kcov, remote_arg->handles[i]);
631eec028c9SAndrey Konovalov 			if (IS_ERR(remote)) {
632eec028c9SAndrey Konovalov 				spin_unlock(&kcov_remote_lock);
633eec028c9SAndrey Konovalov 				kcov_disable(t, kcov);
634eec028c9SAndrey Konovalov 				return PTR_ERR(remote);
635eec028c9SAndrey Konovalov 			}
636eec028c9SAndrey Konovalov 		}
637eec028c9SAndrey Konovalov 		if (remote_arg->common_handle) {
638eec028c9SAndrey Konovalov 			if (!kcov_check_handle(remote_arg->common_handle,
639eec028c9SAndrey Konovalov 						true, false, false)) {
640eec028c9SAndrey Konovalov 				spin_unlock(&kcov_remote_lock);
641eec028c9SAndrey Konovalov 				kcov_disable(t, kcov);
642eec028c9SAndrey Konovalov 				return -EINVAL;
643eec028c9SAndrey Konovalov 			}
644eec028c9SAndrey Konovalov 			remote = kcov_remote_add(kcov,
645eec028c9SAndrey Konovalov 					remote_arg->common_handle);
646eec028c9SAndrey Konovalov 			if (IS_ERR(remote)) {
647eec028c9SAndrey Konovalov 				spin_unlock(&kcov_remote_lock);
648eec028c9SAndrey Konovalov 				kcov_disable(t, kcov);
649eec028c9SAndrey Konovalov 				return PTR_ERR(remote);
650eec028c9SAndrey Konovalov 			}
651eec028c9SAndrey Konovalov 			t->kcov_handle = remote_arg->common_handle;
652eec028c9SAndrey Konovalov 		}
653eec028c9SAndrey Konovalov 		spin_unlock(&kcov_remote_lock);
654eec028c9SAndrey Konovalov 		/* Put either in kcov_task_exit() or in KCOV_DISABLE. */
655eec028c9SAndrey Konovalov 		kcov_get(kcov);
656eec028c9SAndrey Konovalov 		return 0;
6575c9a8750SDmitry Vyukov 	default:
6585c9a8750SDmitry Vyukov 		return -ENOTTY;
6595c9a8750SDmitry Vyukov 	}
6605c9a8750SDmitry Vyukov }
6615c9a8750SDmitry Vyukov 
6625c9a8750SDmitry Vyukov static long kcov_ioctl(struct file *filep, unsigned int cmd, unsigned long arg)
6635c9a8750SDmitry Vyukov {
6645c9a8750SDmitry Vyukov 	struct kcov *kcov;
6655c9a8750SDmitry Vyukov 	int res;
666eec028c9SAndrey Konovalov 	struct kcov_remote_arg *remote_arg = NULL;
667eec028c9SAndrey Konovalov 	unsigned int remote_num_handles;
668eec028c9SAndrey Konovalov 	unsigned long remote_arg_size;
669eec028c9SAndrey Konovalov 
670eec028c9SAndrey Konovalov 	if (cmd == KCOV_REMOTE_ENABLE) {
671eec028c9SAndrey Konovalov 		if (get_user(remote_num_handles, (unsigned __user *)(arg +
672eec028c9SAndrey Konovalov 				offsetof(struct kcov_remote_arg, num_handles))))
673eec028c9SAndrey Konovalov 			return -EFAULT;
674eec028c9SAndrey Konovalov 		if (remote_num_handles > KCOV_REMOTE_MAX_HANDLES)
675eec028c9SAndrey Konovalov 			return -EINVAL;
676eec028c9SAndrey Konovalov 		remote_arg_size = struct_size(remote_arg, handles,
677eec028c9SAndrey Konovalov 					remote_num_handles);
678eec028c9SAndrey Konovalov 		remote_arg = memdup_user((void __user *)arg, remote_arg_size);
679eec028c9SAndrey Konovalov 		if (IS_ERR(remote_arg))
680eec028c9SAndrey Konovalov 			return PTR_ERR(remote_arg);
681eec028c9SAndrey Konovalov 		if (remote_arg->num_handles != remote_num_handles) {
682eec028c9SAndrey Konovalov 			kfree(remote_arg);
683eec028c9SAndrey Konovalov 			return -EINVAL;
684eec028c9SAndrey Konovalov 		}
685eec028c9SAndrey Konovalov 		arg = (unsigned long)remote_arg;
686eec028c9SAndrey Konovalov 	}
6875c9a8750SDmitry Vyukov 
6885c9a8750SDmitry Vyukov 	kcov = filep->private_data;
6895c9a8750SDmitry Vyukov 	spin_lock(&kcov->lock);
6905c9a8750SDmitry Vyukov 	res = kcov_ioctl_locked(kcov, cmd, arg);
6915c9a8750SDmitry Vyukov 	spin_unlock(&kcov->lock);
692eec028c9SAndrey Konovalov 
693eec028c9SAndrey Konovalov 	kfree(remote_arg);
694eec028c9SAndrey Konovalov 
6955c9a8750SDmitry Vyukov 	return res;
6965c9a8750SDmitry Vyukov }
6975c9a8750SDmitry Vyukov 
6985c9a8750SDmitry Vyukov static const struct file_operations kcov_fops = {
6995c9a8750SDmitry Vyukov 	.open		= kcov_open,
7005c9a8750SDmitry Vyukov 	.unlocked_ioctl	= kcov_ioctl,
7017483e5d4SDmitry Vyukov 	.compat_ioctl	= kcov_ioctl,
7025c9a8750SDmitry Vyukov 	.mmap		= kcov_mmap,
7035c9a8750SDmitry Vyukov 	.release        = kcov_close,
7045c9a8750SDmitry Vyukov };
7055c9a8750SDmitry Vyukov 
706eec028c9SAndrey Konovalov /*
707eec028c9SAndrey Konovalov  * kcov_remote_start() and kcov_remote_stop() can be used to annotate a section
708eec028c9SAndrey Konovalov  * of code in a kernel background thread to allow kcov to be used to collect
709eec028c9SAndrey Konovalov  * coverage from that part of code.
710eec028c9SAndrey Konovalov  *
711eec028c9SAndrey Konovalov  * The handle argument of kcov_remote_start() identifies a code section that is
712eec028c9SAndrey Konovalov  * used for coverage collection. A userspace process passes this handle to
713eec028c9SAndrey Konovalov  * KCOV_REMOTE_ENABLE ioctl to make the used kcov device start collecting
714eec028c9SAndrey Konovalov  * coverage for the code section identified by this handle.
715eec028c9SAndrey Konovalov  *
716eec028c9SAndrey Konovalov  * The usage of these annotations in the kernel code is different depending on
717eec028c9SAndrey Konovalov  * the type of the kernel thread whose code is being annotated.
718eec028c9SAndrey Konovalov  *
719eec028c9SAndrey Konovalov  * For global kernel threads that are spawned in a limited number of instances
720eec028c9SAndrey Konovalov  * (e.g. one USB hub_event() worker thread is spawned per USB HCD), each
721eec028c9SAndrey Konovalov  * instance must be assigned a unique 4-byte instance id. The instance id is
722eec028c9SAndrey Konovalov  * then combined with a 1-byte subsystem id to get a handle via
723eec028c9SAndrey Konovalov  * kcov_remote_handle(subsystem_id, instance_id).
724eec028c9SAndrey Konovalov  *
725eec028c9SAndrey Konovalov  * For local kernel threads that are spawned from system calls handler when a
726eec028c9SAndrey Konovalov  * user interacts with some kernel interface (e.g. vhost workers), a handle is
727eec028c9SAndrey Konovalov  * passed from a userspace process as the common_handle field of the
728eec028c9SAndrey Konovalov  * kcov_remote_arg struct (note, that the user must generate a handle by using
729eec028c9SAndrey Konovalov  * kcov_remote_handle() with KCOV_SUBSYSTEM_COMMON as the subsystem id and an
730eec028c9SAndrey Konovalov  * arbitrary 4-byte non-zero number as the instance id). This common handle
731eec028c9SAndrey Konovalov  * then gets saved into the task_struct of the process that issued the
732324cfb19SMaciej Grochowski  * KCOV_REMOTE_ENABLE ioctl. When this process issues system calls that spawn
733324cfb19SMaciej Grochowski  * kernel threads, the common handle must be retrieved via kcov_common_handle()
734eec028c9SAndrey Konovalov  * and passed to the spawned threads via custom annotations. Those kernel
735eec028c9SAndrey Konovalov  * threads must in turn be annotated with kcov_remote_start(common_handle) and
736eec028c9SAndrey Konovalov  * kcov_remote_stop(). All of the threads that are spawned by the same process
737eec028c9SAndrey Konovalov  * obtain the same handle, hence the name "common".
738eec028c9SAndrey Konovalov  *
739eec028c9SAndrey Konovalov  * See Documentation/dev-tools/kcov.rst for more details.
740eec028c9SAndrey Konovalov  *
741eec028c9SAndrey Konovalov  * Internally, this function looks up the kcov device associated with the
742eec028c9SAndrey Konovalov  * provided handle, allocates an area for coverage collection, and saves the
743eec028c9SAndrey Konovalov  * pointers to kcov and area into the current task_struct to allow coverage to
744eec028c9SAndrey Konovalov  * be collected via __sanitizer_cov_trace_pc()
745eec028c9SAndrey Konovalov  * In turns kcov_remote_stop() clears those pointers from task_struct to stop
746eec028c9SAndrey Konovalov  * collecting coverage and copies all collected coverage into the kcov area.
747eec028c9SAndrey Konovalov  */
748eec028c9SAndrey Konovalov void kcov_remote_start(u64 handle)
749eec028c9SAndrey Konovalov {
750eec028c9SAndrey Konovalov 	struct kcov_remote *remote;
751*67b3d3ccSAndrey Konovalov 	struct kcov *kcov;
752eec028c9SAndrey Konovalov 	void *area;
753eec028c9SAndrey Konovalov 	struct task_struct *t;
754eec028c9SAndrey Konovalov 	unsigned int size;
755eec028c9SAndrey Konovalov 	enum kcov_mode mode;
756eec028c9SAndrey Konovalov 	int sequence;
757eec028c9SAndrey Konovalov 
758eec028c9SAndrey Konovalov 	if (WARN_ON(!kcov_check_handle(handle, true, true, true)))
759eec028c9SAndrey Konovalov 		return;
760eec028c9SAndrey Konovalov 	if (WARN_ON(!in_task()))
761eec028c9SAndrey Konovalov 		return;
762eec028c9SAndrey Konovalov 	t = current;
763eec028c9SAndrey Konovalov 	/*
764eec028c9SAndrey Konovalov 	 * Check that kcov_remote_start is not called twice
765eec028c9SAndrey Konovalov 	 * nor called by user tasks (with enabled kcov).
766eec028c9SAndrey Konovalov 	 */
767eec028c9SAndrey Konovalov 	if (WARN_ON(t->kcov))
768eec028c9SAndrey Konovalov 		return;
769eec028c9SAndrey Konovalov 
770eec028c9SAndrey Konovalov 	kcov_debug("handle = %llx\n", handle);
771eec028c9SAndrey Konovalov 
772eec028c9SAndrey Konovalov 	spin_lock(&kcov_remote_lock);
773eec028c9SAndrey Konovalov 	remote = kcov_remote_find(handle);
774eec028c9SAndrey Konovalov 	if (!remote) {
775eec028c9SAndrey Konovalov 		spin_unlock(&kcov_remote_lock);
776eec028c9SAndrey Konovalov 		return;
777eec028c9SAndrey Konovalov 	}
778*67b3d3ccSAndrey Konovalov 	kcov = remote->kcov;
779eec028c9SAndrey Konovalov 	/* Put in kcov_remote_stop(). */
780*67b3d3ccSAndrey Konovalov 	kcov_get(kcov);
781*67b3d3ccSAndrey Konovalov 	t->kcov = kcov;
782eec028c9SAndrey Konovalov 	/*
783eec028c9SAndrey Konovalov 	 * Read kcov fields before unlock to prevent races with
784eec028c9SAndrey Konovalov 	 * KCOV_DISABLE / kcov_remote_reset().
785eec028c9SAndrey Konovalov 	 */
786*67b3d3ccSAndrey Konovalov 	size = kcov->remote_size;
787*67b3d3ccSAndrey Konovalov 	mode = kcov->mode;
788*67b3d3ccSAndrey Konovalov 	sequence = kcov->sequence;
789eec028c9SAndrey Konovalov 	area = kcov_remote_area_get(size);
790eec028c9SAndrey Konovalov 	spin_unlock(&kcov_remote_lock);
791eec028c9SAndrey Konovalov 
792eec028c9SAndrey Konovalov 	if (!area) {
793eec028c9SAndrey Konovalov 		area = vmalloc(size * sizeof(unsigned long));
794eec028c9SAndrey Konovalov 		if (!area) {
795eec028c9SAndrey Konovalov 			t->kcov = NULL;
796*67b3d3ccSAndrey Konovalov 			kcov_put(kcov);
797eec028c9SAndrey Konovalov 			return;
798eec028c9SAndrey Konovalov 		}
799eec028c9SAndrey Konovalov 	}
800eec028c9SAndrey Konovalov 	/* Reset coverage size. */
801eec028c9SAndrey Konovalov 	*(u64 *)area = 0;
802eec028c9SAndrey Konovalov 
803eec028c9SAndrey Konovalov 	kcov_start(t, size, area, mode, sequence);
804eec028c9SAndrey Konovalov 
805eec028c9SAndrey Konovalov }
806eec028c9SAndrey Konovalov EXPORT_SYMBOL(kcov_remote_start);
807eec028c9SAndrey Konovalov 
808eec028c9SAndrey Konovalov static void kcov_move_area(enum kcov_mode mode, void *dst_area,
809eec028c9SAndrey Konovalov 				unsigned int dst_area_size, void *src_area)
810eec028c9SAndrey Konovalov {
811eec028c9SAndrey Konovalov 	u64 word_size = sizeof(unsigned long);
812eec028c9SAndrey Konovalov 	u64 count_size, entry_size_log;
813eec028c9SAndrey Konovalov 	u64 dst_len, src_len;
814eec028c9SAndrey Konovalov 	void *dst_entries, *src_entries;
815eec028c9SAndrey Konovalov 	u64 dst_occupied, dst_free, bytes_to_move, entries_moved;
816eec028c9SAndrey Konovalov 
817eec028c9SAndrey Konovalov 	kcov_debug("%px %u <= %px %lu\n",
818eec028c9SAndrey Konovalov 		dst_area, dst_area_size, src_area, *(unsigned long *)src_area);
819eec028c9SAndrey Konovalov 
820eec028c9SAndrey Konovalov 	switch (mode) {
821eec028c9SAndrey Konovalov 	case KCOV_MODE_TRACE_PC:
822eec028c9SAndrey Konovalov 		dst_len = READ_ONCE(*(unsigned long *)dst_area);
823eec028c9SAndrey Konovalov 		src_len = *(unsigned long *)src_area;
824eec028c9SAndrey Konovalov 		count_size = sizeof(unsigned long);
825eec028c9SAndrey Konovalov 		entry_size_log = __ilog2_u64(sizeof(unsigned long));
826eec028c9SAndrey Konovalov 		break;
827eec028c9SAndrey Konovalov 	case KCOV_MODE_TRACE_CMP:
828eec028c9SAndrey Konovalov 		dst_len = READ_ONCE(*(u64 *)dst_area);
829eec028c9SAndrey Konovalov 		src_len = *(u64 *)src_area;
830eec028c9SAndrey Konovalov 		count_size = sizeof(u64);
831eec028c9SAndrey Konovalov 		BUILD_BUG_ON(!is_power_of_2(KCOV_WORDS_PER_CMP));
832eec028c9SAndrey Konovalov 		entry_size_log = __ilog2_u64(sizeof(u64) * KCOV_WORDS_PER_CMP);
833eec028c9SAndrey Konovalov 		break;
834eec028c9SAndrey Konovalov 	default:
835eec028c9SAndrey Konovalov 		WARN_ON(1);
836eec028c9SAndrey Konovalov 		return;
837eec028c9SAndrey Konovalov 	}
838eec028c9SAndrey Konovalov 
839eec028c9SAndrey Konovalov 	/* As arm can't divide u64 integers use log of entry size. */
840eec028c9SAndrey Konovalov 	if (dst_len > ((dst_area_size * word_size - count_size) >>
841eec028c9SAndrey Konovalov 				entry_size_log))
842eec028c9SAndrey Konovalov 		return;
843eec028c9SAndrey Konovalov 	dst_occupied = count_size + (dst_len << entry_size_log);
844eec028c9SAndrey Konovalov 	dst_free = dst_area_size * word_size - dst_occupied;
845eec028c9SAndrey Konovalov 	bytes_to_move = min(dst_free, src_len << entry_size_log);
846eec028c9SAndrey Konovalov 	dst_entries = dst_area + dst_occupied;
847eec028c9SAndrey Konovalov 	src_entries = src_area + count_size;
848eec028c9SAndrey Konovalov 	memcpy(dst_entries, src_entries, bytes_to_move);
849eec028c9SAndrey Konovalov 	entries_moved = bytes_to_move >> entry_size_log;
850eec028c9SAndrey Konovalov 
851eec028c9SAndrey Konovalov 	switch (mode) {
852eec028c9SAndrey Konovalov 	case KCOV_MODE_TRACE_PC:
853eec028c9SAndrey Konovalov 		WRITE_ONCE(*(unsigned long *)dst_area, dst_len + entries_moved);
854eec028c9SAndrey Konovalov 		break;
855eec028c9SAndrey Konovalov 	case KCOV_MODE_TRACE_CMP:
856eec028c9SAndrey Konovalov 		WRITE_ONCE(*(u64 *)dst_area, dst_len + entries_moved);
857eec028c9SAndrey Konovalov 		break;
858eec028c9SAndrey Konovalov 	default:
859eec028c9SAndrey Konovalov 		break;
860eec028c9SAndrey Konovalov 	}
861eec028c9SAndrey Konovalov }
862eec028c9SAndrey Konovalov 
863eec028c9SAndrey Konovalov /* See the comment before kcov_remote_start() for usage details. */
864eec028c9SAndrey Konovalov void kcov_remote_stop(void)
865eec028c9SAndrey Konovalov {
866eec028c9SAndrey Konovalov 	struct task_struct *t = current;
867eec028c9SAndrey Konovalov 	struct kcov *kcov = t->kcov;
868eec028c9SAndrey Konovalov 	void *area = t->kcov_area;
869eec028c9SAndrey Konovalov 	unsigned int size = t->kcov_size;
870eec028c9SAndrey Konovalov 	int sequence = t->kcov_sequence;
871eec028c9SAndrey Konovalov 
8723c61df38SAndrey Konovalov 	if (!kcov)
873eec028c9SAndrey Konovalov 		return;
874eec028c9SAndrey Konovalov 
875eec028c9SAndrey Konovalov 	kcov_stop(t);
876eec028c9SAndrey Konovalov 	t->kcov = NULL;
877eec028c9SAndrey Konovalov 
878eec028c9SAndrey Konovalov 	spin_lock(&kcov->lock);
879eec028c9SAndrey Konovalov 	/*
880eec028c9SAndrey Konovalov 	 * KCOV_DISABLE could have been called between kcov_remote_start()
881eec028c9SAndrey Konovalov 	 * and kcov_remote_stop(), hence the check.
882eec028c9SAndrey Konovalov 	 */
883eec028c9SAndrey Konovalov 	if (sequence == kcov->sequence && kcov->remote)
884eec028c9SAndrey Konovalov 		kcov_move_area(kcov->mode, kcov->area, kcov->size, area);
885eec028c9SAndrey Konovalov 	spin_unlock(&kcov->lock);
886eec028c9SAndrey Konovalov 
887eec028c9SAndrey Konovalov 	spin_lock(&kcov_remote_lock);
888eec028c9SAndrey Konovalov 	kcov_remote_area_put(area, size);
889eec028c9SAndrey Konovalov 	spin_unlock(&kcov_remote_lock);
890eec028c9SAndrey Konovalov 
891eec028c9SAndrey Konovalov 	kcov_put(kcov);
892eec028c9SAndrey Konovalov }
893eec028c9SAndrey Konovalov EXPORT_SYMBOL(kcov_remote_stop);
894eec028c9SAndrey Konovalov 
895eec028c9SAndrey Konovalov /* See the comment before kcov_remote_start() for usage details. */
896eec028c9SAndrey Konovalov u64 kcov_common_handle(void)
897eec028c9SAndrey Konovalov {
898eec028c9SAndrey Konovalov 	return current->kcov_handle;
899eec028c9SAndrey Konovalov }
900eec028c9SAndrey Konovalov EXPORT_SYMBOL(kcov_common_handle);
901eec028c9SAndrey Konovalov 
9025c9a8750SDmitry Vyukov static int __init kcov_init(void)
9035c9a8750SDmitry Vyukov {
904df4565f9SNicolai Stange 	/*
905df4565f9SNicolai Stange 	 * The kcov debugfs file won't ever get removed and thus,
906df4565f9SNicolai Stange 	 * there is no need to protect it against removal races. The
907df4565f9SNicolai Stange 	 * use of debugfs_create_file_unsafe() is actually safe here.
908df4565f9SNicolai Stange 	 */
909ec9672d5SGreg Kroah-Hartman 	debugfs_create_file_unsafe("kcov", 0600, NULL, NULL, &kcov_fops);
910ec9672d5SGreg Kroah-Hartman 
9115c9a8750SDmitry Vyukov 	return 0;
9125c9a8750SDmitry Vyukov }
9135c9a8750SDmitry Vyukov 
9145c9a8750SDmitry Vyukov device_initcall(kcov_init);
915