/*
 * Copyright (C) 2007-2009 Michal Simek <monstr@monstr.eu>
 * Copyright (C) 2007-2009 PetaLogix
 * Copyright (C) 2006 Atmark Techno, Inc.
 *
 * This file is subject to the terms and conditions of the GNU General Public
 * License. See the file "COPYING" in the main directory of this archive
 * for more details.
 */

#include <linux/cpu.h>
#include <linux/export.h>
#include <linux/kernel.h>
#include <linux/kallsyms.h>
#include <linux/sched.h>
#include <linux/sched/debug.h>
#include <linux/debug_locks.h>

#include <asm/exceptions.h>
#include <asm/unwind.h>

void trap_init(void)
{
 __enable_hw_exceptions();
}

static unsigned long kstack_depth_to_print; /* 0 == entire stack */

static int __init kstack_setup(char *s)
{
 return !kstrtoul(s, 0, &kstack_depth_to_print);
}
__setup("kstack=", kstack_setup);

void show_stack(struct task_struct *task, unsigned long *sp, const char *loglvl)
{
 unsigned long words_to_show;
 u32 fp = (u32) sp;

 if (fp == 0) {
  if (task) {
   fp = ((struct thread_info *)
    (task->stack))->cpu_context.r1;
  } else {
   /* Pick up caller of dump_stack() */
   fp = (u32)&sp - 8;
  }
 }

 words_to_show = (THREAD_SIZE - (fp & (THREAD_SIZE - 1))) >> 2;
 if (kstack_depth_to_print && (words_to_show > kstack_depth_to_print))
  words_to_show = kstack_depth_to_print;

 printk("%sKernel Stack:\n", loglvl);

 /*
 * Make the first line an 'odd' size if necessary to get
 * remaining lines to start at an address multiple of 0x10
 */
 if (fp & 0xF) {
  unsigned long line1_words = (0x10 - (fp & 0xF)) >> 2;
  if (line1_words < words_to_show) {
   print_hex_dump(KERN_INFO, "", DUMP_PREFIX_ADDRESS, 32,
           4, (void *)fp, line1_words << 2, 0);
   fp += line1_words << 2;
   words_to_show -= line1_words;
  }
 }
 print_hex_dump(loglvl, "", DUMP_PREFIX_ADDRESS, 32, 4, (void *)fp,
         words_to_show << 2, 0);
 printk("%s\n\nCall Trace:\n", loglvl);
 microblaze_unwind(task, NULL, loglvl);
 printk("%s\n", loglvl);

 if (!task)
  task = current;

 debug_show_held_locks(task);
}