1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun * Copyright (C) 2014 Google, Inc.
3*4882a593Smuzhiyun *
4*4882a593Smuzhiyun * This software is licensed under the terms of the GNU General Public
5*4882a593Smuzhiyun * License version 2, as published by the Free Software Foundation, and
6*4882a593Smuzhiyun * may be copied, distributed, and modified under those terms.
7*4882a593Smuzhiyun *
8*4882a593Smuzhiyun * This program is distributed in the hope that it will be useful,
9*4882a593Smuzhiyun * but WITHOUT ANY WARRANTY; without even the implied warranty of
10*4882a593Smuzhiyun * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
11*4882a593Smuzhiyun * GNU General Public License for more details.
12*4882a593Smuzhiyun *
13*4882a593Smuzhiyun */
14*4882a593Smuzhiyun
15*4882a593Smuzhiyun #include <linux/kernel.h>
16*4882a593Smuzhiyun #include <linux/spinlock.h>
17*4882a593Smuzhiyun #include <linux/pstore_ram.h>
18*4882a593Smuzhiyun
19*4882a593Smuzhiyun #include "fiq_watchdog.h"
20*4882a593Smuzhiyun #include "fiq_debugger_priv.h"
21*4882a593Smuzhiyun
22*4882a593Smuzhiyun static DEFINE_RAW_SPINLOCK(fiq_watchdog_lock);
23*4882a593Smuzhiyun
fiq_watchdog_printf(struct fiq_debugger_output * output,const char * fmt,...)24*4882a593Smuzhiyun static void fiq_watchdog_printf(struct fiq_debugger_output *output,
25*4882a593Smuzhiyun const char *fmt, ...)
26*4882a593Smuzhiyun {
27*4882a593Smuzhiyun char buf[256];
28*4882a593Smuzhiyun va_list ap;
29*4882a593Smuzhiyun int len;
30*4882a593Smuzhiyun
31*4882a593Smuzhiyun va_start(ap, fmt);
32*4882a593Smuzhiyun len = vscnprintf(buf, sizeof(buf), fmt, ap);
33*4882a593Smuzhiyun va_end(ap);
34*4882a593Smuzhiyun
35*4882a593Smuzhiyun ramoops_console_write_buf(buf, len);
36*4882a593Smuzhiyun }
37*4882a593Smuzhiyun
38*4882a593Smuzhiyun struct fiq_debugger_output fiq_watchdog_output = {
39*4882a593Smuzhiyun .printf = fiq_watchdog_printf,
40*4882a593Smuzhiyun };
41*4882a593Smuzhiyun
fiq_watchdog_triggered(const struct pt_regs * regs,void * svc_sp)42*4882a593Smuzhiyun void fiq_watchdog_triggered(const struct pt_regs *regs, void *svc_sp)
43*4882a593Smuzhiyun {
44*4882a593Smuzhiyun char msg[24];
45*4882a593Smuzhiyun int len;
46*4882a593Smuzhiyun
47*4882a593Smuzhiyun raw_spin_lock(&fiq_watchdog_lock);
48*4882a593Smuzhiyun
49*4882a593Smuzhiyun len = scnprintf(msg, sizeof(msg), "watchdog fiq cpu %d\n",
50*4882a593Smuzhiyun THREAD_INFO(svc_sp)->cpu);
51*4882a593Smuzhiyun ramoops_console_write_buf(msg, len);
52*4882a593Smuzhiyun
53*4882a593Smuzhiyun fiq_debugger_dump_stacktrace(&fiq_watchdog_output, regs, 100, svc_sp);
54*4882a593Smuzhiyun
55*4882a593Smuzhiyun raw_spin_unlock(&fiq_watchdog_lock);
56*4882a593Smuzhiyun }
57