2 * SDK7786 FPGA NMI Support.
4 * Copyright (C) 2010 Paul Mundt
6 * This file is subject to the terms and conditions of the GNU General Public
7 * License. See the file "COPYING" in the main directory of this archive
10 #include <linux/init.h>
11 #include <linux/kernel.h>
12 #include <linux/string.h>
13 #include <mach/fpga.h>
24 * Default to the manual NMI switch.
26 static unsigned int __initdata nmi_mode = NMI_MODE_ANY;
28 static int __init nmi_mode_setup(char *str)
33 if (strcmp(str, "manual") == 0)
34 nmi_mode = NMI_MODE_MANUAL;
35 else if (strcmp(str, "aux") == 0)
36 nmi_mode = NMI_MODE_AUX;
37 else if (strcmp(str, "masked") == 0)
38 nmi_mode = NMI_MODE_MASKED;
39 else if (strcmp(str, "any") == 0)
40 nmi_mode = NMI_MODE_ANY;
42 nmi_mode = NMI_MODE_UNKNOWN;
43 pr_warning("Unknown NMI mode %s\n", str);
46 printk("Set NMI mode to %d\n", nmi_mode);
49 early_param("nmi_mode", nmi_mode_setup);
51 void __init sdk7786_nmi_init(void)
53 unsigned int source, mask, tmp;
57 source = NMISR_MAN_NMI;
58 mask = NMIMR_MAN_NMIM;
61 source = NMISR_AUX_NMI;
62 mask = NMIMR_AUX_NMIM;
65 source = NMISR_MAN_NMI | NMISR_AUX_NMI;
66 mask = NMIMR_MAN_NMIM | NMIMR_AUX_NMIM;
69 case NMI_MODE_UNKNOWN:
75 /* Set the NMI source */
76 tmp = fpga_read_reg(NMISR);
79 fpga_write_reg(tmp, NMISR);
81 /* And the IRQ masking */
82 fpga_write_reg(NMIMR_MASK ^ mask, NMIMR);