tegrakernel/kernel/nvidia/drivers/misc/tegra-profiler/backtrace.c

620 lines
14 KiB
C
Raw Normal View History

2022-02-16 09:13:02 -06:00
/*
* drivers/misc/tegra-profiler/backtrace.c
*
* Copyright (c) 2015-2019, NVIDIA CORPORATION. All rights reserved.
*
* This program is free software; you can redistribute it and/or modify it
* under the terms and conditions of the GNU General Public License,
* version 2, as published by the Free Software Foundation.
*
* This program is distributed in the hope it will be useful, but WITHOUT
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
* more details.
*
*/
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
#include <linux/uaccess.h>
#include <linux/sched.h>
#include <linux/mm.h>
#include <linux/tegra_profiler.h>
#include "quadd.h"
#include "backtrace.h"
#include "eh_unwind.h"
#include "dwarf_unwind.h"
#include "hrt.h"
#include "tegra.h"
static inline bool
is_table_unwinding(struct quadd_callchain *cc)
{
return cc->um.ut != 0 || cc->um.dwarf != 0;
}
unsigned long
quadd_user_stack_pointer(struct pt_regs *regs)
{
#ifdef CONFIG_ARM64
if (compat_user_mode(regs))
return regs->compat_sp;
#endif
return user_stack_pointer(regs);
}
unsigned long
quadd_get_user_frame_pointer(struct pt_regs *regs)
{
unsigned long fp;
#ifdef CONFIG_ARM64
if (compat_user_mode(regs))
fp = is_thumb_mode(regs) ?
regs->compat_usr(7) : regs->compat_usr(11);
else
fp = regs->regs[29];
#else
fp = is_thumb_mode(regs) ? regs->ARM_r7 : regs->ARM_fp;
#endif
return fp;
}
unsigned long
quadd_user_link_register(struct pt_regs *regs)
{
#ifdef CONFIG_ARM64
return compat_user_mode(regs) ?
regs->compat_lr : regs->regs[30];
#else
return regs->ARM_lr;
#endif
}
static inline void
put_unw_type(u32 *p, int bt_idx, unsigned int type)
{
int word_idx, shift;
word_idx = bt_idx / 8;
shift = (bt_idx % 8) * 4;
*(p + word_idx) &= ~(0x0f << shift);
*(p + word_idx) |= (type & 0x0f) << shift;
}
int
quadd_callchain_store(struct quadd_callchain *cc,
unsigned long ip, unsigned int type)
{
unsigned long low_addr = cc->hrt->low_addr;
if (ip < low_addr || !validate_pc_addr(ip, sizeof(unsigned long))) {
cc->urc_fp = QUADD_URC_PC_INCORRECT;
return 0;
}
if (cc->nr >= QUADD_MAX_STACK_DEPTH) {
cc->urc_fp = QUADD_URC_LEVEL_TOO_DEEP;
return 0;
}
put_unw_type(cc->types, cc->nr, type);
if (cc->cs_64)
cc->ip_64[cc->nr++] = ip;
else
cc->ip_32[cc->nr++] = ip;
return 1;
}
static bool
is_ex_entry_exist(struct quadd_event_context *event_ctx,
struct quadd_callchain *cc, unsigned long addr)
{
struct quadd_unw_methods *um = &cc->um;
if (um->dwarf) {
if (quadd_is_ex_entry_exist_dwarf(event_ctx, addr))
return true;
}
if (um->ut) {
if (quadd_is_ex_entry_exist_arm32_ehabi(event_ctx, addr))
return true;
}
return false;
}
static unsigned long __user *
user_backtrace(struct quadd_event_context *event_ctx,
unsigned long __user *tail,
struct quadd_callchain *cc,
struct vm_area_struct *stack_vma)
{
long err;
int nr_added;
unsigned long value, value_lr = 0, value_fp = 0;
unsigned long __user *fp_prev = NULL;
if (!validate_stack_addr((unsigned long)tail, stack_vma,
sizeof(*tail), cc->cs_64))
return NULL;
err = read_user_data(&value, tail, sizeof(unsigned long));
if (err < 0) {
cc->urc_fp = -err;
return NULL;
}
if (validate_stack_addr(value, stack_vma, sizeof(value), cc->cs_64)) {
/* gcc thumb/clang frame */
value_fp = value;
if (!validate_stack_addr((unsigned long)(tail + 1), stack_vma,
sizeof(*tail), cc->cs_64))
return NULL;
err = read_user_data(&value_lr, tail + 1, sizeof(value_lr));
if (err < 0) {
cc->urc_fp = -err;
return NULL;
}
cc->curr_fp = value_fp;
cc->curr_sp = (unsigned long)tail + sizeof(value_fp) * 2;
cc->curr_pc = cc->curr_lr = value_lr;
} else {
/* gcc arm frame */
err = read_user_data(&value_fp, tail - 1, sizeof(value_fp));
if (err < 0) {
cc->urc_fp = -err;
return NULL;
}
if (!validate_stack_addr(value_fp, stack_vma,
sizeof(value_fp), cc->cs_64))
return NULL;
cc->curr_fp = value_fp;
cc->curr_sp = (unsigned long)tail + sizeof(value_fp);
cc->curr_pc = cc->curr_lr = value_lr = value;
}
fp_prev = (unsigned long __user *)value_fp;
if (fp_prev <= tail)
return NULL;
nr_added = quadd_callchain_store(cc, value_lr, QUADD_UNW_TYPE_FP);
if (nr_added == 0)
return NULL;
if (is_table_unwinding(cc) &&
is_ex_entry_exist(event_ctx, cc, value_lr))
return NULL;
return fp_prev;
}
static unsigned int
get_user_callchain_fp(struct quadd_event_context *event_ctx,
struct quadd_callchain *cc)
{
long err = 0;
unsigned long fp, sp, pc, reg;
struct vm_area_struct *vma, *vma_pc = NULL;
unsigned long __user *tail = NULL;
struct pt_regs *regs = event_ctx->regs;
struct mm_struct *mm = event_ctx->task->mm;
cc->urc_fp = QUADD_URC_FP_INCORRECT;
if (!regs || !mm) {
cc->urc_fp = QUADD_URC_FAILURE;
return 0;
}
sp = quadd_user_stack_pointer(regs);
pc = instruction_pointer(regs);
fp = quadd_get_user_frame_pointer(regs);
if (fp == 0 || fp < sp)
return 0;
vma = find_vma(mm, sp);
if (!vma) {
cc->urc_fp = QUADD_URC_SP_INCORRECT;
return 0;
}
if (!validate_stack_addr(fp, vma, sizeof(fp), cc->cs_64))
return 0;
err = read_user_data(&reg, (void __user *)fp, sizeof(reg));
if (err < 0) {
cc->urc_fp = -err;
return 0;
}
pr_debug("sp/fp: %#lx/%#lx, pc/lr: %#lx/%#lx, *fp: %#lx, stack: %#lx-%#lx\n",
sp, fp, pc, quadd_user_link_register(regs), reg,
vma->vm_start, vma->vm_end);
if (is_thumb_mode(regs)) {
if (reg <= fp || !is_vma_addr(reg, vma, sizeof(reg)))
return 0;
} else if (reg > fp && is_vma_addr(reg, vma, sizeof(reg))) {
/* fp --> fp prev */
unsigned long value;
int read_lr = 0;
if (validate_stack_addr(fp + sizeof(unsigned long),
vma, sizeof(fp), cc->cs_64)) {
err = read_user_data(&value,
(unsigned long __user *)fp + 1,
sizeof(unsigned long));
if (err < 0) {
cc->urc_fp = -err;
return 0;
}
vma_pc = find_vma(mm, pc);
read_lr = 1;
}
if (!read_lr || !is_vma_addr(value, vma_pc, sizeof(value))) {
/* gcc: fp --> short frame tail (fp) */
int nr_added;
unsigned long lr = quadd_user_link_register(regs);
nr_added = quadd_callchain_store(cc, lr,
QUADD_UNW_TYPE_FP);
if (nr_added == 0)
return cc->nr;
tail = (unsigned long __user *)reg;
}
}
if (!tail)
tail = (unsigned long __user *)fp;
while (tail && !((unsigned long)tail & 0x3))
tail = user_backtrace(event_ctx, tail, cc, vma);
return cc->nr;
}
static unsigned int
__user_backtrace(struct quadd_event_context *event_ctx,
struct quadd_callchain *cc)
{
struct vm_area_struct *vma;
unsigned long __user *tail;
struct mm_struct *mm = event_ctx->task->mm;
cc->urc_fp = QUADD_URC_FP_INCORRECT;
if (!mm) {
cc->urc_fp = QUADD_URC_FAILURE;
return cc->nr;
}
vma = find_vma(mm, cc->curr_sp);
if (!vma) {
cc->urc_fp = QUADD_URC_SP_INCORRECT;
return cc->nr;
}
tail = (unsigned long __user *)cc->curr_fp;
while (tail && !((unsigned long)tail & 0x3))
tail = user_backtrace(event_ctx, tail, cc, vma);
return cc->nr;
}
#ifdef CONFIG_ARM64
static u32 __user *
user_backtrace_compat(struct quadd_event_context *event_ctx,
u32 __user *tail,
struct quadd_callchain *cc,
struct vm_area_struct *stack_vma)
{
long err;
int nr_added;
u32 value, value_lr = 0, value_fp = 0;
u32 __user *fp_prev = NULL;
if (!validate_stack_addr((unsigned long)tail, stack_vma,
sizeof(*tail), cc->cs_64))
return NULL;
err = read_user_data(&value, tail, sizeof(value));
if (err < 0) {
cc->urc_fp = -err;
return NULL;
}
if (validate_stack_addr(value, stack_vma, sizeof(value), cc->cs_64)) {
/* gcc thumb/clang frame */
value_fp = value;
if (!validate_stack_addr((unsigned long)(tail + 1), stack_vma,
sizeof(*tail), cc->cs_64))
return NULL;
err = read_user_data(&value_lr, tail + 1, sizeof(value_lr));
if (err < 0) {
cc->urc_fp = -err;
return NULL;
}
cc->curr_fp = value_fp;
cc->curr_sp = (unsigned long)tail + sizeof(value_fp) * 2;
cc->curr_pc = cc->curr_lr = value_lr;
} else {
/* gcc arm frame */
err = read_user_data(&value_fp, tail - 1, sizeof(value_fp));
if (err < 0) {
cc->urc_fp = -err;
return NULL;
}
if (!validate_stack_addr(value_fp, stack_vma,
sizeof(value_fp), cc->cs_64))
return NULL;
cc->curr_fp = value_fp;
cc->curr_sp = (unsigned long)tail + sizeof(value_fp);
cc->curr_pc = cc->curr_lr = value_lr = value;
}
fp_prev = (u32 __user *)(unsigned long)value_fp;
if (fp_prev <= tail)
return NULL;
nr_added = quadd_callchain_store(cc, value_lr, QUADD_UNW_TYPE_FP);
if (nr_added == 0)
return NULL;
if (is_table_unwinding(cc) &&
is_ex_entry_exist(event_ctx, cc, value_lr))
return NULL;
return fp_prev;
}
static unsigned int
get_user_callchain_fp_compat(struct quadd_event_context *event_ctx,
struct quadd_callchain *cc)
{
long err;
u32 fp, sp, pc, reg;
struct vm_area_struct *vma, *vma_pc = NULL;
u32 __user *tail = NULL;
struct pt_regs *regs = event_ctx->regs;
struct mm_struct *mm = event_ctx->task->mm;
cc->urc_fp = QUADD_URC_FP_INCORRECT;
if (!regs || !mm) {
cc->urc_fp = QUADD_URC_FAILURE;
return 0;
}
sp = quadd_user_stack_pointer(regs);
pc = instruction_pointer(regs);
fp = quadd_get_user_frame_pointer(regs);
if (fp == 0 || fp < sp)
return 0;
vma = find_vma(mm, sp);
if (!vma) {
cc->urc_fp = QUADD_URC_SP_INCORRECT;
return 0;
}
if (!validate_stack_addr(fp, vma, sizeof(fp), cc->cs_64))
return 0;
err = read_user_data(&reg, (void __user *)(unsigned long)fp,
sizeof(reg));
if (err < 0) {
cc->urc_fp = -err;
return 0;
}
pr_debug("sp/fp: %#x/%#x, pc/lr: %#x/%#x, *fp: %#x, stack: %#lx-%#lx\n",
sp, fp, pc, (u32)quadd_user_link_register(regs), reg,
vma->vm_start, vma->vm_end);
if (is_thumb_mode(regs)) {
if (reg <= fp || !is_vma_addr(reg, vma, sizeof(reg)))
return 0;
} else if (reg > fp && is_vma_addr(reg, vma, sizeof(reg))) {
/* fp --> fp prev */
u32 value;
int read_lr = 0;
if (validate_stack_addr(fp + sizeof(u32), vma,
sizeof(fp), cc->cs_64)) {
err = read_user_data(&value,
(u32 __user *)(fp + sizeof(u32)),
sizeof(value));
if (err < 0) {
cc->urc_fp = -err;
return 0;
}
vma_pc = find_vma(mm, pc);
read_lr = 1;
}
if (!read_lr || !is_vma_addr(value, vma_pc, sizeof(value))) {
/* gcc: fp --> short frame tail (fp) */
int nr_added;
u32 lr = quadd_user_link_register(regs);
nr_added = quadd_callchain_store(cc, lr,
QUADD_UNW_TYPE_FP);
if (nr_added == 0)
return cc->nr;
tail = (u32 __user *)(unsigned long)reg;
}
}
if (!tail)
tail = (u32 __user *)(unsigned long)fp;
while (tail && !((unsigned long)tail & 0x3))
tail = user_backtrace_compat(event_ctx, tail, cc, vma);
return cc->nr;
}
static unsigned int
__user_backtrace_compat(struct quadd_event_context *event_ctx,
struct quadd_callchain *cc)
{
struct mm_struct *mm = event_ctx->task->mm;
struct vm_area_struct *vma;
u32 __user *tail;
cc->urc_fp = QUADD_URC_FP_INCORRECT;
if (!mm) {
cc->urc_fp = QUADD_URC_FAILURE;
return cc->nr;
}
vma = find_vma(mm, cc->curr_sp);
if (!vma) {
cc->urc_fp = QUADD_URC_SP_INCORRECT;
return cc->nr;
}
tail = (u32 __user *)cc->curr_fp;
while (tail && !((unsigned long)tail & 0x3))
tail = user_backtrace_compat(event_ctx, tail, cc, vma);
return cc->nr;
}
#endif /* CONFIG_ARM64 */
static unsigned int
__get_user_callchain_fp(struct quadd_event_context *event_ctx,
struct quadd_callchain *cc)
{
#ifdef CONFIG_ARM64
struct pt_regs *regs = event_ctx->regs;
#endif
if (cc->curr_sp) {
if (cc->urc_fp == QUADD_URC_LEVEL_TOO_DEEP)
return cc->nr;
#ifdef CONFIG_ARM64
if (compat_user_mode(regs))
__user_backtrace_compat(event_ctx, cc);
else
__user_backtrace(event_ctx, cc);
#else
__user_backtrace(event_ctx, cc);
#endif
return cc->nr;
}
#ifdef CONFIG_ARM64
if (compat_user_mode(regs))
return get_user_callchain_fp_compat(event_ctx, cc);
#endif
return get_user_callchain_fp(event_ctx, cc);
}
static unsigned int
get_user_callchain_mixed(struct quadd_event_context *event_ctx,
struct quadd_callchain *cc)
{
int nr_prev, nr_added, is_stack_ok;
unsigned long pc, prev_sp, align_mask;
struct quadd_unw_methods *um = &cc->um;
if (!event_ctx->user_mode) {
pc = instruction_pointer(event_ctx->regs);
nr_added = quadd_callchain_store(cc, pc, QUADD_UNW_TYPE_KCTX);
if (nr_added == 0)
return cc->nr;
}
align_mask = cc->cs_64 ? 0x07 : 0x03;
do {
nr_prev = cc->nr;
prev_sp = cc->curr_sp;
if (um->dwarf)
quadd_get_user_cc_dwarf(event_ctx, cc);
if (um->ut)
quadd_get_user_cc_arm32_ehabi(event_ctx, cc);
if (um->fp && nr_prev == cc->nr)
__get_user_callchain_fp(event_ctx, cc);
is_stack_ok = cc->nr <= 1 ?
cc->curr_sp >= prev_sp : cc->curr_sp > prev_sp;
is_stack_ok = (cc->curr_sp & align_mask) ? 0 : is_stack_ok;
} while (nr_prev != cc->nr && is_stack_ok);
return cc->nr;
}
unsigned int
quadd_get_user_callchain(struct quadd_event_context *event_ctx,
struct quadd_callchain *cc,
struct quadd_ctx *ctx)
{
struct pt_regs *regs = event_ctx->regs;
cc->nr = 0;
cc->curr_sp = 0;
cc->curr_fp = 0;
cc->curr_fp_thumb = 0;
cc->curr_pc = 0;
cc->curr_lr = 0;
if (!regs) {
cc->urc_fp = QUADD_URC_FAILURE;
cc->urc_ut = QUADD_URC_FAILURE;
cc->urc_dwarf = QUADD_URC_FAILURE;
return 0;
}
#ifdef CONFIG_ARM64
cc->cs_64 = compat_user_mode(regs) ? 0 : 1;
#else
cc->cs_64 = 0;
#endif
cc->urc_fp = QUADD_URC_NONE;
cc->urc_ut = QUADD_URC_NONE;
cc->urc_dwarf = QUADD_URC_NONE;
get_user_callchain_mixed(event_ctx, cc);
return cc->nr;
}