1e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo/*
2e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo * Mostly IRQ support for Hexagon
3e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo *
47c6a5df44fd90a288fe067581c5564859c071fc0Richard Kuo * Copyright (c) 2010-2012, The Linux Foundation. All rights reserved.
5e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo *
6e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo * This program is free software; you can redistribute it and/or modify
7e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo * it under the terms of the GNU General Public License version 2 and
8e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo * only version 2 as published by the Free Software Foundation.
9e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo *
10e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo * This program is distributed in the hope that it will be useful,
11e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo * but WITHOUT ANY WARRANTY; without even the implied warranty of
12e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
13e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo * GNU General Public License for more details.
14e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo *
15e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo * You should have received a copy of the GNU General Public License
16e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo * along with this program; if not, write to the Free Software
17e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
18e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo * 02110-1301, USA.
19e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo */
20e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo
21e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo#include <linux/kernel.h>
22e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo#include <asm/registers.h>
23e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo#include <linux/irq.h>
24e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo#include <linux/hardirq.h>
25e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo
26e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo/*
27e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo * show_regs - print pt_regs structure
28e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo * @regs: pointer to pt_regs
29e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo *
30e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo * To-do:  add all the accessor definitions to registers.h
31e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo *
32e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo * Will make this routine a lot easier to write.
33e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo */
34e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuovoid show_regs(struct pt_regs *regs)
35e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo{
36a43cb95d547a061ed5bf1acb28e0f5fd575e26c1Tejun Heo	show_regs_print_info(KERN_EMERG);
37a43cb95d547a061ed5bf1acb28e0f5fd575e26c1Tejun Heo
38e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo	printk(KERN_EMERG "restart_r0: \t0x%08lx   syscall_nr: %ld\n",
39e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo	       regs->restart_r0, regs->syscall_nr);
40e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo	printk(KERN_EMERG "preds: \t\t0x%08lx\n", regs->preds);
41e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo	printk(KERN_EMERG "lc0: \t0x%08lx   sa0: 0x%08lx   m0:  0x%08lx\n",
42e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo	       regs->lc0, regs->sa0, regs->m0);
43e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo	printk(KERN_EMERG "lc1: \t0x%08lx   sa1: 0x%08lx   m1:  0x%08lx\n",
44e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo	       regs->lc1, regs->sa1, regs->m1);
45e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo	printk(KERN_EMERG "gp: \t0x%08lx   ugp: 0x%08lx   usr: 0x%08lx\n",
46e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo	       regs->gp, regs->ugp, regs->usr);
4760c4ba99e015afe879c2682967c8ca8d233f6d3cRichard Kuo	printk(KERN_EMERG "cs0: \t0x%08lx   cs1: 0x%08lx\n",
4860c4ba99e015afe879c2682967c8ca8d233f6d3cRichard Kuo	       regs->cs0, regs->cs1);
49e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo	printk(KERN_EMERG "r0: \t0x%08lx %08lx %08lx %08lx\n", regs->r00,
50e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo		regs->r01,
51e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo		regs->r02,
52e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo		regs->r03);
53e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo	printk(KERN_EMERG "r4:  \t0x%08lx %08lx %08lx %08lx\n", regs->r04,
54e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo		regs->r05,
55e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo		regs->r06,
56e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo		regs->r07);
57e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo	printk(KERN_EMERG "r8:  \t0x%08lx %08lx %08lx %08lx\n", regs->r08,
58e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo		regs->r09,
59e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo		regs->r10,
60e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo		regs->r11);
61e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo	printk(KERN_EMERG "r12: \t0x%08lx %08lx %08lx %08lx\n", regs->r12,
62e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo		regs->r13,
63e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo		regs->r14,
64e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo		regs->r15);
65e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo	printk(KERN_EMERG "r16: \t0x%08lx %08lx %08lx %08lx\n", regs->r16,
66e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo		regs->r17,
67e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo		regs->r18,
68e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo		regs->r19);
69e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo	printk(KERN_EMERG "r20: \t0x%08lx %08lx %08lx %08lx\n", regs->r20,
70e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo		regs->r21,
71e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo		regs->r22,
72e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo		regs->r23);
73e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo	printk(KERN_EMERG "r24: \t0x%08lx %08lx %08lx %08lx\n", regs->r24,
74e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo		regs->r25,
75e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo		regs->r26,
76e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo		regs->r27);
77e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo	printk(KERN_EMERG "r28: \t0x%08lx %08lx %08lx %08lx\n", regs->r28,
78e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo		regs->r29,
79e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo		regs->r30,
80e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo		regs->r31);
81e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo
82e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo	printk(KERN_EMERG "elr: \t0x%08lx   cause: 0x%08lx   user_mode: %d\n",
83e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo		pt_elr(regs), pt_cause(regs), user_mode(regs));
84e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo	printk(KERN_EMERG "psp: \t0x%08lx   badva: 0x%08lx   int_enabled: %d\n",
85e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo		pt_psp(regs), pt_badva(regs), ints_enabled(regs));
86e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo}
87e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo
88e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuovoid dummy_handler(struct pt_regs *regs)
89e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo{
90e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo	unsigned int elr = pt_elr(regs);
91e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo	printk(KERN_ERR "Unimplemented handler; ELR=0x%08x\n", elr);
92e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo}
93e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo
94e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo
95e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuovoid arch_do_IRQ(struct pt_regs *regs)
96e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo{
97e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo	int irq = pt_cause(regs);
98e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo	struct pt_regs *old_regs = set_irq_regs(regs);
99e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo
100e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo	irq_enter();
101e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo	generic_handle_irq(irq);
102e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo	irq_exit();
103e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo	set_irq_regs(old_regs);
104e49ee2906c94cd6a339b2012c23e39d1a39f79e3Richard Kuo}
105