powerpc/xics: Harden xics hypervisor backend
[firefly-linux-kernel-4.4.55.git] / arch / powerpc / sysdev / xics / icp-hv.c
1 /*
2  * Copyright 2011 IBM Corporation.
3  *
4  *  This program is free software; you can redistribute it and/or
5  *  modify it under the terms of the GNU General Public License
6  *  as published by the Free Software Foundation; either version
7  *  2 of the License, or (at your option) any later version.
8  *
9  */
10 #include <linux/types.h>
11 #include <linux/kernel.h>
12 #include <linux/irq.h>
13 #include <linux/smp.h>
14 #include <linux/interrupt.h>
15 #include <linux/init.h>
16 #include <linux/cpu.h>
17 #include <linux/of.h>
18
19 #include <asm/smp.h>
20 #include <asm/irq.h>
21 #include <asm/errno.h>
22 #include <asm/xics.h>
23 #include <asm/io.h>
24 #include <asm/hvcall.h>
25
26 static inline unsigned int icp_hv_get_xirr(unsigned char cppr)
27 {
28         unsigned long retbuf[PLPAR_HCALL_BUFSIZE];
29         long rc;
30         unsigned int ret = XICS_IRQ_SPURIOUS;
31
32         rc = plpar_hcall(H_XIRR, retbuf, cppr);
33         if (rc == H_SUCCESS) {
34                 ret = (unsigned int)retbuf[0];
35         } else {
36                 pr_err("%s: bad return code xirr cppr=0x%x returned %ld\n",
37                         __func__, cppr, rc);
38                 WARN_ON_ONCE(1);
39         }
40
41         return ret;
42 }
43
44 static inline void icp_hv_set_xirr(unsigned int value)
45 {
46         long rc = plpar_hcall_norets(H_EOI, value);
47         if (rc != H_SUCCESS) {
48                 pr_err("%s: bad return code eoi xirr=0x%x returned %ld\n",
49                         __func__, value, rc);
50                 WARN_ON_ONCE(1);
51         }
52 }
53
54 static inline void icp_hv_set_cppr(u8 value)
55 {
56         long rc = plpar_hcall_norets(H_CPPR, value);
57         if (rc != H_SUCCESS) {
58                 pr_err("%s: bad return code cppr cppr=0x%x returned %ld\n",
59                         __func__, value, rc);
60                 WARN_ON_ONCE(1);
61         }
62 }
63
64 static inline void icp_hv_set_qirr(int n_cpu , u8 value)
65 {
66         int hw_cpu = get_hard_smp_processor_id(n_cpu);
67         long rc = plpar_hcall_norets(H_IPI, hw_cpu, value);
68         if (rc != H_SUCCESS) {
69                 pr_err("%s: bad return code qirr cpu=%d hw_cpu=%d mfrr=0x%x "
70                         "returned %ld\n", __func__, n_cpu, hw_cpu, value, rc);
71                 WARN_ON_ONCE(1);
72         }
73 }
74
75 static void icp_hv_eoi(struct irq_data *d)
76 {
77         unsigned int hw_irq = (unsigned int)irqd_to_hwirq(d);
78
79         iosync();
80         icp_hv_set_xirr((xics_pop_cppr() << 24) | hw_irq);
81 }
82
83 static void icp_hv_teardown_cpu(void)
84 {
85         int cpu = smp_processor_id();
86
87         /* Clear any pending IPI */
88         icp_hv_set_qirr(cpu, 0xff);
89 }
90
91 static void icp_hv_flush_ipi(void)
92 {
93         /* We take the ipi irq but and never return so we
94          * need to EOI the IPI, but want to leave our priority 0
95          *
96          * should we check all the other interrupts too?
97          * should we be flagging idle loop instead?
98          * or creating some task to be scheduled?
99          */
100
101         icp_hv_set_xirr((0x00 << 24) | XICS_IPI);
102 }
103
104 static unsigned int icp_hv_get_irq(void)
105 {
106         unsigned int xirr = icp_hv_get_xirr(xics_cppr_top());
107         unsigned int vec = xirr & 0x00ffffff;
108         unsigned int irq;
109
110         if (vec == XICS_IRQ_SPURIOUS)
111                 return NO_IRQ;
112
113         irq = irq_radix_revmap_lookup(xics_host, vec);
114         if (likely(irq != NO_IRQ)) {
115                 xics_push_cppr(vec);
116                 return irq;
117         }
118
119         /* We don't have a linux mapping, so have rtas mask it. */
120         xics_mask_unknown_vec(vec);
121
122         /* We might learn about it later, so EOI it */
123         icp_hv_set_xirr(xirr);
124
125         return NO_IRQ;
126 }
127
128 static void icp_hv_set_cpu_priority(unsigned char cppr)
129 {
130         xics_set_base_cppr(cppr);
131         icp_hv_set_cppr(cppr);
132         iosync();
133 }
134
135 #ifdef CONFIG_SMP
136
137 static void icp_hv_cause_ipi(int cpu, unsigned long data)
138 {
139         icp_hv_set_qirr(cpu, IPI_PRIORITY);
140 }
141
142 static irqreturn_t icp_hv_ipi_action(int irq, void *dev_id)
143 {
144         int cpu = smp_processor_id();
145
146         icp_hv_set_qirr(cpu, 0xff);
147
148         return smp_ipi_demux();
149 }
150
151 #endif /* CONFIG_SMP */
152
153 static const struct icp_ops icp_hv_ops = {
154         .get_irq        = icp_hv_get_irq,
155         .eoi            = icp_hv_eoi,
156         .set_priority   = icp_hv_set_cpu_priority,
157         .teardown_cpu   = icp_hv_teardown_cpu,
158         .flush_ipi      = icp_hv_flush_ipi,
159 #ifdef CONFIG_SMP
160         .ipi_action     = icp_hv_ipi_action,
161         .cause_ipi      = icp_hv_cause_ipi,
162 #endif
163 };
164
165 int icp_hv_init(void)
166 {
167         struct device_node *np;
168
169         np = of_find_compatible_node(NULL, NULL, "ibm,ppc-xicp");
170         if (!np)
171                 np = of_find_node_by_type(NULL,
172                                     "PowerPC-External-Interrupt-Presentation");
173         if (!np)
174                 return -ENODEV;
175
176         icp_ops = &icp_hv_ops;
177
178         return 0;
179 }
180