18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
28c2ecf20Sopenharmony_ci/*
38c2ecf20Sopenharmony_ci * SH specific backtracing code for oprofile
48c2ecf20Sopenharmony_ci *
58c2ecf20Sopenharmony_ci * Copyright 2007 STMicroelectronics Ltd.
68c2ecf20Sopenharmony_ci *
78c2ecf20Sopenharmony_ci * Author: Dave Peverley <dpeverley@mpc-data.co.uk>
88c2ecf20Sopenharmony_ci *
98c2ecf20Sopenharmony_ci * Based on ARM oprofile backtrace code by Richard Purdie and in turn, i386
108c2ecf20Sopenharmony_ci * oprofile backtrace code by John Levon, David Smith
118c2ecf20Sopenharmony_ci */
128c2ecf20Sopenharmony_ci#include <linux/oprofile.h>
138c2ecf20Sopenharmony_ci#include <linux/sched.h>
148c2ecf20Sopenharmony_ci#include <linux/kallsyms.h>
158c2ecf20Sopenharmony_ci#include <linux/mm.h>
168c2ecf20Sopenharmony_ci#include <asm/unwinder.h>
178c2ecf20Sopenharmony_ci#include <asm/ptrace.h>
188c2ecf20Sopenharmony_ci#include <linux/uaccess.h>
198c2ecf20Sopenharmony_ci#include <asm/sections.h>
208c2ecf20Sopenharmony_ci#include <asm/stacktrace.h>
218c2ecf20Sopenharmony_ci
228c2ecf20Sopenharmony_cistatic void backtrace_address(void *data, unsigned long addr, int reliable)
238c2ecf20Sopenharmony_ci{
248c2ecf20Sopenharmony_ci	unsigned int *depth = data;
258c2ecf20Sopenharmony_ci
268c2ecf20Sopenharmony_ci	if ((*depth)--)
278c2ecf20Sopenharmony_ci		oprofile_add_trace(addr);
288c2ecf20Sopenharmony_ci}
298c2ecf20Sopenharmony_ci
308c2ecf20Sopenharmony_cistatic struct stacktrace_ops backtrace_ops = {
318c2ecf20Sopenharmony_ci	.address = backtrace_address,
328c2ecf20Sopenharmony_ci};
338c2ecf20Sopenharmony_ci
348c2ecf20Sopenharmony_ci/* Limit to stop backtracing too far. */
358c2ecf20Sopenharmony_cistatic int backtrace_limit = 20;
368c2ecf20Sopenharmony_ci
378c2ecf20Sopenharmony_cistatic unsigned long *
388c2ecf20Sopenharmony_ciuser_backtrace(unsigned long *stackaddr, struct pt_regs *regs)
398c2ecf20Sopenharmony_ci{
408c2ecf20Sopenharmony_ci	unsigned long buf_stack;
418c2ecf20Sopenharmony_ci
428c2ecf20Sopenharmony_ci	/* Also check accessibility of address */
438c2ecf20Sopenharmony_ci	if (!access_ok(stackaddr, sizeof(unsigned long)))
448c2ecf20Sopenharmony_ci		return NULL;
458c2ecf20Sopenharmony_ci
468c2ecf20Sopenharmony_ci	if (__copy_from_user_inatomic(&buf_stack, stackaddr, sizeof(unsigned long)))
478c2ecf20Sopenharmony_ci		return NULL;
488c2ecf20Sopenharmony_ci
498c2ecf20Sopenharmony_ci	/* Quick paranoia check */
508c2ecf20Sopenharmony_ci	if (buf_stack & 3)
518c2ecf20Sopenharmony_ci		return NULL;
528c2ecf20Sopenharmony_ci
538c2ecf20Sopenharmony_ci	oprofile_add_trace(buf_stack);
548c2ecf20Sopenharmony_ci
558c2ecf20Sopenharmony_ci	stackaddr++;
568c2ecf20Sopenharmony_ci
578c2ecf20Sopenharmony_ci	return stackaddr;
588c2ecf20Sopenharmony_ci}
598c2ecf20Sopenharmony_ci
608c2ecf20Sopenharmony_civoid sh_backtrace(struct pt_regs * const regs, unsigned int depth)
618c2ecf20Sopenharmony_ci{
628c2ecf20Sopenharmony_ci	unsigned long *stackaddr;
638c2ecf20Sopenharmony_ci
648c2ecf20Sopenharmony_ci	/*
658c2ecf20Sopenharmony_ci	 * Paranoia - clip max depth as we could get lost in the weeds.
668c2ecf20Sopenharmony_ci	 */
678c2ecf20Sopenharmony_ci	if (depth > backtrace_limit)
688c2ecf20Sopenharmony_ci		depth = backtrace_limit;
698c2ecf20Sopenharmony_ci
708c2ecf20Sopenharmony_ci	stackaddr = (unsigned long *)kernel_stack_pointer(regs);
718c2ecf20Sopenharmony_ci	if (!user_mode(regs)) {
728c2ecf20Sopenharmony_ci		if (depth)
738c2ecf20Sopenharmony_ci			unwind_stack(NULL, regs, stackaddr,
748c2ecf20Sopenharmony_ci				     &backtrace_ops, &depth);
758c2ecf20Sopenharmony_ci		return;
768c2ecf20Sopenharmony_ci	}
778c2ecf20Sopenharmony_ci
788c2ecf20Sopenharmony_ci	while (depth-- && (stackaddr != NULL))
798c2ecf20Sopenharmony_ci		stackaddr = user_backtrace(stackaddr, regs);
808c2ecf20Sopenharmony_ci}
81