Loading...
1// SPDX-License-Identifier: GPL-2.0
2/*
3 * arch/sh/kernel/hw_breakpoint.c
4 *
5 * Unified kernel/user-space hardware breakpoint facility for the on-chip UBC.
6 *
7 * Copyright (C) 2009 - 2010 Paul Mundt
8 */
9#include <linux/init.h>
10#include <linux/perf_event.h>
11#include <linux/sched/signal.h>
12#include <linux/hw_breakpoint.h>
13#include <linux/percpu.h>
14#include <linux/kallsyms.h>
15#include <linux/notifier.h>
16#include <linux/kprobes.h>
17#include <linux/kdebug.h>
18#include <linux/io.h>
19#include <linux/clk.h>
20#include <asm/hw_breakpoint.h>
21#include <asm/mmu_context.h>
22#include <asm/ptrace.h>
23#include <asm/traps.h>
24
25/*
26 * Stores the breakpoints currently in use on each breakpoint address
27 * register for each cpus
28 */
29static DEFINE_PER_CPU(struct perf_event *, bp_per_reg[HBP_NUM]);
30
31/*
32 * A dummy placeholder for early accesses until the CPUs get a chance to
33 * register their UBCs later in the boot process.
34 */
35static struct sh_ubc ubc_dummy = { .num_events = 0 };
36
37static struct sh_ubc *sh_ubc __read_mostly = &ubc_dummy;
38
39/*
40 * Install a perf counter breakpoint.
41 *
42 * We seek a free UBC channel and use it for this breakpoint.
43 *
44 * Atomic: we hold the counter->ctx->lock and we only handle variables
45 * and registers local to this cpu.
46 */
47int arch_install_hw_breakpoint(struct perf_event *bp)
48{
49 struct arch_hw_breakpoint *info = counter_arch_bp(bp);
50 int i;
51
52 for (i = 0; i < sh_ubc->num_events; i++) {
53 struct perf_event **slot = this_cpu_ptr(&bp_per_reg[i]);
54
55 if (!*slot) {
56 *slot = bp;
57 break;
58 }
59 }
60
61 if (WARN_ONCE(i == sh_ubc->num_events, "Can't find any breakpoint slot"))
62 return -EBUSY;
63
64 clk_enable(sh_ubc->clk);
65 sh_ubc->enable(info, i);
66
67 return 0;
68}
69
70/*
71 * Uninstall the breakpoint contained in the given counter.
72 *
73 * First we search the debug address register it uses and then we disable
74 * it.
75 *
76 * Atomic: we hold the counter->ctx->lock and we only handle variables
77 * and registers local to this cpu.
78 */
79void arch_uninstall_hw_breakpoint(struct perf_event *bp)
80{
81 struct arch_hw_breakpoint *info = counter_arch_bp(bp);
82 int i;
83
84 for (i = 0; i < sh_ubc->num_events; i++) {
85 struct perf_event **slot = this_cpu_ptr(&bp_per_reg[i]);
86
87 if (*slot == bp) {
88 *slot = NULL;
89 break;
90 }
91 }
92
93 if (WARN_ONCE(i == sh_ubc->num_events, "Can't find any breakpoint slot"))
94 return;
95
96 sh_ubc->disable(info, i);
97 clk_disable(sh_ubc->clk);
98}
99
100static int get_hbp_len(u16 hbp_len)
101{
102 unsigned int len_in_bytes = 0;
103
104 switch (hbp_len) {
105 case SH_BREAKPOINT_LEN_1:
106 len_in_bytes = 1;
107 break;
108 case SH_BREAKPOINT_LEN_2:
109 len_in_bytes = 2;
110 break;
111 case SH_BREAKPOINT_LEN_4:
112 len_in_bytes = 4;
113 break;
114 case SH_BREAKPOINT_LEN_8:
115 len_in_bytes = 8;
116 break;
117 }
118 return len_in_bytes;
119}
120
121/*
122 * Check for virtual address in kernel space.
123 */
124int arch_check_bp_in_kernelspace(struct arch_hw_breakpoint *hw)
125{
126 unsigned int len;
127 unsigned long va;
128
129 va = hw->address;
130 len = get_hbp_len(hw->len);
131
132 return (va >= TASK_SIZE) && ((va + len - 1) >= TASK_SIZE);
133}
134
135int arch_bp_generic_fields(int sh_len, int sh_type,
136 int *gen_len, int *gen_type)
137{
138 /* Len */
139 switch (sh_len) {
140 case SH_BREAKPOINT_LEN_1:
141 *gen_len = HW_BREAKPOINT_LEN_1;
142 break;
143 case SH_BREAKPOINT_LEN_2:
144 *gen_len = HW_BREAKPOINT_LEN_2;
145 break;
146 case SH_BREAKPOINT_LEN_4:
147 *gen_len = HW_BREAKPOINT_LEN_4;
148 break;
149 case SH_BREAKPOINT_LEN_8:
150 *gen_len = HW_BREAKPOINT_LEN_8;
151 break;
152 default:
153 return -EINVAL;
154 }
155
156 /* Type */
157 switch (sh_type) {
158 case SH_BREAKPOINT_READ:
159 *gen_type = HW_BREAKPOINT_R;
160 break;
161 case SH_BREAKPOINT_WRITE:
162 *gen_type = HW_BREAKPOINT_W;
163 break;
164 case SH_BREAKPOINT_RW:
165 *gen_type = HW_BREAKPOINT_W | HW_BREAKPOINT_R;
166 break;
167 default:
168 return -EINVAL;
169 }
170
171 return 0;
172}
173
174static int arch_build_bp_info(struct perf_event *bp,
175 const struct perf_event_attr *attr,
176 struct arch_hw_breakpoint *hw)
177{
178 hw->address = attr->bp_addr;
179
180 /* Len */
181 switch (attr->bp_len) {
182 case HW_BREAKPOINT_LEN_1:
183 hw->len = SH_BREAKPOINT_LEN_1;
184 break;
185 case HW_BREAKPOINT_LEN_2:
186 hw->len = SH_BREAKPOINT_LEN_2;
187 break;
188 case HW_BREAKPOINT_LEN_4:
189 hw->len = SH_BREAKPOINT_LEN_4;
190 break;
191 case HW_BREAKPOINT_LEN_8:
192 hw->len = SH_BREAKPOINT_LEN_8;
193 break;
194 default:
195 return -EINVAL;
196 }
197
198 /* Type */
199 switch (attr->bp_type) {
200 case HW_BREAKPOINT_R:
201 hw->type = SH_BREAKPOINT_READ;
202 break;
203 case HW_BREAKPOINT_W:
204 hw->type = SH_BREAKPOINT_WRITE;
205 break;
206 case HW_BREAKPOINT_W | HW_BREAKPOINT_R:
207 hw->type = SH_BREAKPOINT_RW;
208 break;
209 default:
210 return -EINVAL;
211 }
212
213 return 0;
214}
215
216/*
217 * Validate the arch-specific HW Breakpoint register settings
218 */
219int hw_breakpoint_arch_parse(struct perf_event *bp,
220 const struct perf_event_attr *attr,
221 struct arch_hw_breakpoint *hw)
222{
223 unsigned int align;
224 int ret;
225
226 ret = arch_build_bp_info(bp, attr, hw);
227 if (ret)
228 return ret;
229
230 ret = -EINVAL;
231
232 switch (hw->len) {
233 case SH_BREAKPOINT_LEN_1:
234 align = 0;
235 break;
236 case SH_BREAKPOINT_LEN_2:
237 align = 1;
238 break;
239 case SH_BREAKPOINT_LEN_4:
240 align = 3;
241 break;
242 case SH_BREAKPOINT_LEN_8:
243 align = 7;
244 break;
245 default:
246 return ret;
247 }
248
249 /*
250 * Check that the low-order bits of the address are appropriate
251 * for the alignment implied by len.
252 */
253 if (hw->address & align)
254 return -EINVAL;
255
256 return 0;
257}
258
259/*
260 * Release the user breakpoints used by ptrace
261 */
262void flush_ptrace_hw_breakpoint(struct task_struct *tsk)
263{
264 int i;
265 struct thread_struct *t = &tsk->thread;
266
267 for (i = 0; i < sh_ubc->num_events; i++) {
268 unregister_hw_breakpoint(t->ptrace_bps[i]);
269 t->ptrace_bps[i] = NULL;
270 }
271}
272
273static int __kprobes hw_breakpoint_handler(struct die_args *args)
274{
275 int cpu, i, rc = NOTIFY_STOP;
276 struct perf_event *bp;
277 unsigned int cmf, resume_mask;
278
279 /*
280 * Do an early return if none of the channels triggered.
281 */
282 cmf = sh_ubc->triggered_mask();
283 if (unlikely(!cmf))
284 return NOTIFY_DONE;
285
286 /*
287 * By default, resume all of the active channels.
288 */
289 resume_mask = sh_ubc->active_mask();
290
291 /*
292 * Disable breakpoints during exception handling.
293 */
294 sh_ubc->disable_all();
295
296 cpu = get_cpu();
297 for (i = 0; i < sh_ubc->num_events; i++) {
298 unsigned long event_mask = (1 << i);
299
300 if (likely(!(cmf & event_mask)))
301 continue;
302
303 /*
304 * The counter may be concurrently released but that can only
305 * occur from a call_rcu() path. We can then safely fetch
306 * the breakpoint, use its callback, touch its counter
307 * while we are in an rcu_read_lock() path.
308 */
309 rcu_read_lock();
310
311 bp = per_cpu(bp_per_reg[i], cpu);
312 if (bp)
313 rc = NOTIFY_DONE;
314
315 /*
316 * Reset the condition match flag to denote completion of
317 * exception handling.
318 */
319 sh_ubc->clear_triggered_mask(event_mask);
320
321 /*
322 * bp can be NULL due to concurrent perf counter
323 * removing.
324 */
325 if (!bp) {
326 rcu_read_unlock();
327 break;
328 }
329
330 /*
331 * Don't restore the channel if the breakpoint is from
332 * ptrace, as it always operates in one-shot mode.
333 */
334 if (bp->overflow_handler == ptrace_triggered)
335 resume_mask &= ~(1 << i);
336
337 perf_bp_event(bp, args->regs);
338
339 /* Deliver the signal to userspace */
340 if (!arch_check_bp_in_kernelspace(&bp->hw.info)) {
341 force_sig_fault(SIGTRAP, TRAP_HWBKPT,
342 (void __user *)NULL);
343 }
344
345 rcu_read_unlock();
346 }
347
348 if (cmf == 0)
349 rc = NOTIFY_DONE;
350
351 sh_ubc->enable_all(resume_mask);
352
353 put_cpu();
354
355 return rc;
356}
357
358BUILD_TRAP_HANDLER(breakpoint)
359{
360 unsigned long ex = lookup_exception_vector();
361 TRAP_HANDLER_DECL;
362
363 notify_die(DIE_BREAKPOINT, "breakpoint", regs, 0, ex, SIGTRAP);
364}
365
366/*
367 * Handle debug exception notifications.
368 */
369int __kprobes hw_breakpoint_exceptions_notify(struct notifier_block *unused,
370 unsigned long val, void *data)
371{
372 struct die_args *args = data;
373
374 if (val != DIE_BREAKPOINT)
375 return NOTIFY_DONE;
376
377 /*
378 * If the breakpoint hasn't been triggered by the UBC, it's
379 * probably from a debugger, so don't do anything more here.
380 *
381 * This also permits the UBC interface clock to remain off for
382 * non-UBC breakpoints, as we don't need to check the triggered
383 * or active channel masks.
384 */
385 if (args->trapnr != sh_ubc->trap_nr)
386 return NOTIFY_DONE;
387
388 return hw_breakpoint_handler(data);
389}
390
391void hw_breakpoint_pmu_read(struct perf_event *bp)
392{
393 /* TODO */
394}
395
396int register_sh_ubc(struct sh_ubc *ubc)
397{
398 /* Bail if it's already assigned */
399 if (sh_ubc != &ubc_dummy)
400 return -EBUSY;
401 sh_ubc = ubc;
402
403 pr_info("HW Breakpoints: %s UBC support registered\n", ubc->name);
404
405 WARN_ON(ubc->num_events > HBP_NUM);
406
407 return 0;
408}
1/*
2 * arch/sh/kernel/hw_breakpoint.c
3 *
4 * Unified kernel/user-space hardware breakpoint facility for the on-chip UBC.
5 *
6 * Copyright (C) 2009 - 2010 Paul Mundt
7 *
8 * This file is subject to the terms and conditions of the GNU General Public
9 * License. See the file "COPYING" in the main directory of this archive
10 * for more details.
11 */
12#include <linux/init.h>
13#include <linux/perf_event.h>
14#include <linux/sched/signal.h>
15#include <linux/hw_breakpoint.h>
16#include <linux/percpu.h>
17#include <linux/kallsyms.h>
18#include <linux/notifier.h>
19#include <linux/kprobes.h>
20#include <linux/kdebug.h>
21#include <linux/io.h>
22#include <linux/clk.h>
23#include <asm/hw_breakpoint.h>
24#include <asm/mmu_context.h>
25#include <asm/ptrace.h>
26#include <asm/traps.h>
27
28/*
29 * Stores the breakpoints currently in use on each breakpoint address
30 * register for each cpus
31 */
32static DEFINE_PER_CPU(struct perf_event *, bp_per_reg[HBP_NUM]);
33
34/*
35 * A dummy placeholder for early accesses until the CPUs get a chance to
36 * register their UBCs later in the boot process.
37 */
38static struct sh_ubc ubc_dummy = { .num_events = 0 };
39
40static struct sh_ubc *sh_ubc __read_mostly = &ubc_dummy;
41
42/*
43 * Install a perf counter breakpoint.
44 *
45 * We seek a free UBC channel and use it for this breakpoint.
46 *
47 * Atomic: we hold the counter->ctx->lock and we only handle variables
48 * and registers local to this cpu.
49 */
50int arch_install_hw_breakpoint(struct perf_event *bp)
51{
52 struct arch_hw_breakpoint *info = counter_arch_bp(bp);
53 int i;
54
55 for (i = 0; i < sh_ubc->num_events; i++) {
56 struct perf_event **slot = this_cpu_ptr(&bp_per_reg[i]);
57
58 if (!*slot) {
59 *slot = bp;
60 break;
61 }
62 }
63
64 if (WARN_ONCE(i == sh_ubc->num_events, "Can't find any breakpoint slot"))
65 return -EBUSY;
66
67 clk_enable(sh_ubc->clk);
68 sh_ubc->enable(info, i);
69
70 return 0;
71}
72
73/*
74 * Uninstall the breakpoint contained in the given counter.
75 *
76 * First we search the debug address register it uses and then we disable
77 * it.
78 *
79 * Atomic: we hold the counter->ctx->lock and we only handle variables
80 * and registers local to this cpu.
81 */
82void arch_uninstall_hw_breakpoint(struct perf_event *bp)
83{
84 struct arch_hw_breakpoint *info = counter_arch_bp(bp);
85 int i;
86
87 for (i = 0; i < sh_ubc->num_events; i++) {
88 struct perf_event **slot = this_cpu_ptr(&bp_per_reg[i]);
89
90 if (*slot == bp) {
91 *slot = NULL;
92 break;
93 }
94 }
95
96 if (WARN_ONCE(i == sh_ubc->num_events, "Can't find any breakpoint slot"))
97 return;
98
99 sh_ubc->disable(info, i);
100 clk_disable(sh_ubc->clk);
101}
102
103static int get_hbp_len(u16 hbp_len)
104{
105 unsigned int len_in_bytes = 0;
106
107 switch (hbp_len) {
108 case SH_BREAKPOINT_LEN_1:
109 len_in_bytes = 1;
110 break;
111 case SH_BREAKPOINT_LEN_2:
112 len_in_bytes = 2;
113 break;
114 case SH_BREAKPOINT_LEN_4:
115 len_in_bytes = 4;
116 break;
117 case SH_BREAKPOINT_LEN_8:
118 len_in_bytes = 8;
119 break;
120 }
121 return len_in_bytes;
122}
123
124/*
125 * Check for virtual address in kernel space.
126 */
127int arch_check_bp_in_kernelspace(struct perf_event *bp)
128{
129 unsigned int len;
130 unsigned long va;
131 struct arch_hw_breakpoint *info = counter_arch_bp(bp);
132
133 va = info->address;
134 len = get_hbp_len(info->len);
135
136 return (va >= TASK_SIZE) && ((va + len - 1) >= TASK_SIZE);
137}
138
139int arch_bp_generic_fields(int sh_len, int sh_type,
140 int *gen_len, int *gen_type)
141{
142 /* Len */
143 switch (sh_len) {
144 case SH_BREAKPOINT_LEN_1:
145 *gen_len = HW_BREAKPOINT_LEN_1;
146 break;
147 case SH_BREAKPOINT_LEN_2:
148 *gen_len = HW_BREAKPOINT_LEN_2;
149 break;
150 case SH_BREAKPOINT_LEN_4:
151 *gen_len = HW_BREAKPOINT_LEN_4;
152 break;
153 case SH_BREAKPOINT_LEN_8:
154 *gen_len = HW_BREAKPOINT_LEN_8;
155 break;
156 default:
157 return -EINVAL;
158 }
159
160 /* Type */
161 switch (sh_type) {
162 case SH_BREAKPOINT_READ:
163 *gen_type = HW_BREAKPOINT_R;
164 case SH_BREAKPOINT_WRITE:
165 *gen_type = HW_BREAKPOINT_W;
166 break;
167 case SH_BREAKPOINT_RW:
168 *gen_type = HW_BREAKPOINT_W | HW_BREAKPOINT_R;
169 break;
170 default:
171 return -EINVAL;
172 }
173
174 return 0;
175}
176
177static int arch_build_bp_info(struct perf_event *bp)
178{
179 struct arch_hw_breakpoint *info = counter_arch_bp(bp);
180
181 info->address = bp->attr.bp_addr;
182
183 /* Len */
184 switch (bp->attr.bp_len) {
185 case HW_BREAKPOINT_LEN_1:
186 info->len = SH_BREAKPOINT_LEN_1;
187 break;
188 case HW_BREAKPOINT_LEN_2:
189 info->len = SH_BREAKPOINT_LEN_2;
190 break;
191 case HW_BREAKPOINT_LEN_4:
192 info->len = SH_BREAKPOINT_LEN_4;
193 break;
194 case HW_BREAKPOINT_LEN_8:
195 info->len = SH_BREAKPOINT_LEN_8;
196 break;
197 default:
198 return -EINVAL;
199 }
200
201 /* Type */
202 switch (bp->attr.bp_type) {
203 case HW_BREAKPOINT_R:
204 info->type = SH_BREAKPOINT_READ;
205 break;
206 case HW_BREAKPOINT_W:
207 info->type = SH_BREAKPOINT_WRITE;
208 break;
209 case HW_BREAKPOINT_W | HW_BREAKPOINT_R:
210 info->type = SH_BREAKPOINT_RW;
211 break;
212 default:
213 return -EINVAL;
214 }
215
216 return 0;
217}
218
219/*
220 * Validate the arch-specific HW Breakpoint register settings
221 */
222int arch_validate_hwbkpt_settings(struct perf_event *bp)
223{
224 struct arch_hw_breakpoint *info = counter_arch_bp(bp);
225 unsigned int align;
226 int ret;
227
228 ret = arch_build_bp_info(bp);
229 if (ret)
230 return ret;
231
232 ret = -EINVAL;
233
234 switch (info->len) {
235 case SH_BREAKPOINT_LEN_1:
236 align = 0;
237 break;
238 case SH_BREAKPOINT_LEN_2:
239 align = 1;
240 break;
241 case SH_BREAKPOINT_LEN_4:
242 align = 3;
243 break;
244 case SH_BREAKPOINT_LEN_8:
245 align = 7;
246 break;
247 default:
248 return ret;
249 }
250
251 /*
252 * For kernel-addresses, either the address or symbol name can be
253 * specified.
254 */
255 if (info->name)
256 info->address = (unsigned long)kallsyms_lookup_name(info->name);
257
258 /*
259 * Check that the low-order bits of the address are appropriate
260 * for the alignment implied by len.
261 */
262 if (info->address & align)
263 return -EINVAL;
264
265 return 0;
266}
267
268/*
269 * Release the user breakpoints used by ptrace
270 */
271void flush_ptrace_hw_breakpoint(struct task_struct *tsk)
272{
273 int i;
274 struct thread_struct *t = &tsk->thread;
275
276 for (i = 0; i < sh_ubc->num_events; i++) {
277 unregister_hw_breakpoint(t->ptrace_bps[i]);
278 t->ptrace_bps[i] = NULL;
279 }
280}
281
282static int __kprobes hw_breakpoint_handler(struct die_args *args)
283{
284 int cpu, i, rc = NOTIFY_STOP;
285 struct perf_event *bp;
286 unsigned int cmf, resume_mask;
287
288 /*
289 * Do an early return if none of the channels triggered.
290 */
291 cmf = sh_ubc->triggered_mask();
292 if (unlikely(!cmf))
293 return NOTIFY_DONE;
294
295 /*
296 * By default, resume all of the active channels.
297 */
298 resume_mask = sh_ubc->active_mask();
299
300 /*
301 * Disable breakpoints during exception handling.
302 */
303 sh_ubc->disable_all();
304
305 cpu = get_cpu();
306 for (i = 0; i < sh_ubc->num_events; i++) {
307 unsigned long event_mask = (1 << i);
308
309 if (likely(!(cmf & event_mask)))
310 continue;
311
312 /*
313 * The counter may be concurrently released but that can only
314 * occur from a call_rcu() path. We can then safely fetch
315 * the breakpoint, use its callback, touch its counter
316 * while we are in an rcu_read_lock() path.
317 */
318 rcu_read_lock();
319
320 bp = per_cpu(bp_per_reg[i], cpu);
321 if (bp)
322 rc = NOTIFY_DONE;
323
324 /*
325 * Reset the condition match flag to denote completion of
326 * exception handling.
327 */
328 sh_ubc->clear_triggered_mask(event_mask);
329
330 /*
331 * bp can be NULL due to concurrent perf counter
332 * removing.
333 */
334 if (!bp) {
335 rcu_read_unlock();
336 break;
337 }
338
339 /*
340 * Don't restore the channel if the breakpoint is from
341 * ptrace, as it always operates in one-shot mode.
342 */
343 if (bp->overflow_handler == ptrace_triggered)
344 resume_mask &= ~(1 << i);
345
346 perf_bp_event(bp, args->regs);
347
348 /* Deliver the signal to userspace */
349 if (!arch_check_bp_in_kernelspace(bp)) {
350 siginfo_t info;
351
352 info.si_signo = args->signr;
353 info.si_errno = notifier_to_errno(rc);
354 info.si_code = TRAP_HWBKPT;
355
356 force_sig_info(args->signr, &info, current);
357 }
358
359 rcu_read_unlock();
360 }
361
362 if (cmf == 0)
363 rc = NOTIFY_DONE;
364
365 sh_ubc->enable_all(resume_mask);
366
367 put_cpu();
368
369 return rc;
370}
371
372BUILD_TRAP_HANDLER(breakpoint)
373{
374 unsigned long ex = lookup_exception_vector();
375 TRAP_HANDLER_DECL;
376
377 notify_die(DIE_BREAKPOINT, "breakpoint", regs, 0, ex, SIGTRAP);
378}
379
380/*
381 * Handle debug exception notifications.
382 */
383int __kprobes hw_breakpoint_exceptions_notify(struct notifier_block *unused,
384 unsigned long val, void *data)
385{
386 struct die_args *args = data;
387
388 if (val != DIE_BREAKPOINT)
389 return NOTIFY_DONE;
390
391 /*
392 * If the breakpoint hasn't been triggered by the UBC, it's
393 * probably from a debugger, so don't do anything more here.
394 *
395 * This also permits the UBC interface clock to remain off for
396 * non-UBC breakpoints, as we don't need to check the triggered
397 * or active channel masks.
398 */
399 if (args->trapnr != sh_ubc->trap_nr)
400 return NOTIFY_DONE;
401
402 return hw_breakpoint_handler(data);
403}
404
405void hw_breakpoint_pmu_read(struct perf_event *bp)
406{
407 /* TODO */
408}
409
410int register_sh_ubc(struct sh_ubc *ubc)
411{
412 /* Bail if it's already assigned */
413 if (sh_ubc != &ubc_dummy)
414 return -EBUSY;
415 sh_ubc = ubc;
416
417 pr_info("HW Breakpoints: %s UBC support registered\n", ubc->name);
418
419 WARN_ON(ubc->num_events > HBP_NUM);
420
421 return 0;
422}