1 /* 2 * Open Multi-Processor Interrupt Controller driver 3 * 4 * Copyright (C) 2014 Stefan Kristiansson <stefan.kristiansson@saunalahti.fi> 5 * Copyright (C) 2017 Stafford Horne <shorne@gmail.com> 6 * 7 * This file is licensed under the terms of the GNU General Public License 8 * version 2. This program is licensed "as is" without any warranty of any 9 * kind, whether express or implied. 10 * 11 * The ompic device handles IPI communication between cores in multi-core 12 * OpenRISC systems. 13 * 14 * Registers 15 * 16 * For each CPU the ompic has 2 registers. The control register for sending 17 * and acking IPIs and the status register for receiving IPIs. The register 18 * layouts are as follows: 19 * 20 * Control register 21 * +---------+---------+----------+---------+ 22 * | 31 | 30 | 29 .. 16 | 15 .. 0 | 23 * ----------+---------+----------+---------- 24 * | IRQ ACK | IRQ GEN | DST CORE | DATA | 25 * +---------+---------+----------+---------+ 26 * 27 * Status register 28 * +----------+-------------+----------+---------+ 29 * | 31 | 30 | 29 .. 16 | 15 .. 0 | 30 * -----------+-------------+----------+---------+ 31 * | Reserved | IRQ Pending | SRC CORE | DATA | 32 * +----------+-------------+----------+---------+ 33 * 34 * Architecture 35 * 36 * - The ompic generates a level interrupt to the CPU PIC when a message is 37 * ready. Messages are delivered via the memory bus. 38 * - The ompic does not have any interrupt input lines. 39 * - The ompic is wired to the same irq line on each core. 40 * - Devices are wired to the same irq line on each core. 41 * 42 * +---------+ +---------+ 43 * | CPU | | CPU | 44 * | Core 0 |<==\ (memory access) /==>| Core 1 | 45 * | [ PIC ]| | | | [ PIC ]| 46 * +----^-^--+ | | +----^-^--+ 47 * | | v v | | 48 * <====|=|=================================|=|==> (memory bus) 49 * | | ^ ^ | | 50 * (ipi | +------|---------+--------|-------|-+ (device irq) 51 * irq | | | | | 52 * core0)| +------|---------|--------|-------+ (ipi irq core1) 53 * | | | | | 54 * +----o-o-+ | +--------+ | 55 * | ompic |<===/ | Device |<===/ 56 * | IPI | +--------+ 57 * +--------+* 58 * 59 */ 60 61 #include <linux/io.h> 62 #include <linux/ioport.h> 63 #include <linux/interrupt.h> 64 #include <linux/smp.h> 65 #include <linux/of.h> 66 #include <linux/of_irq.h> 67 #include <linux/of_address.h> 68 69 #include <linux/irqchip.h> 70 71 #define OMPIC_CPUBYTES 8 72 #define OMPIC_CTRL(cpu) (0x0 + (cpu * OMPIC_CPUBYTES)) 73 #define OMPIC_STAT(cpu) (0x4 + (cpu * OMPIC_CPUBYTES)) 74 75 #define OMPIC_CTRL_IRQ_ACK (1 << 31) 76 #define OMPIC_CTRL_IRQ_GEN (1 << 30) 77 #define OMPIC_CTRL_DST(cpu) (((cpu) & 0x3fff) << 16) 78 79 #define OMPIC_STAT_IRQ_PENDING (1 << 30) 80 81 #define OMPIC_DATA(x) ((x) & 0xffff) 82 83 DEFINE_PER_CPU(unsigned long, ops); 84 85 static void __iomem *ompic_base; 86 ompic_readreg(void __iomem * base,loff_t offset)87 static inline u32 ompic_readreg(void __iomem *base, loff_t offset) 88 { 89 return ioread32be(base + offset); 90 } 91 ompic_writereg(void __iomem * base,loff_t offset,u32 data)92 static void ompic_writereg(void __iomem *base, loff_t offset, u32 data) 93 { 94 iowrite32be(data, base + offset); 95 } 96 ompic_raise_softirq(const struct cpumask * mask,unsigned int ipi_msg)97 static void ompic_raise_softirq(const struct cpumask *mask, 98 unsigned int ipi_msg) 99 { 100 unsigned int dst_cpu; 101 unsigned int src_cpu = smp_processor_id(); 102 103 for_each_cpu(dst_cpu, mask) { 104 set_bit(ipi_msg, &per_cpu(ops, dst_cpu)); 105 106 /* 107 * On OpenRISC the atomic set_bit() call implies a memory 108 * barrier. Otherwise we would need: smp_wmb(); paired 109 * with the read in ompic_ipi_handler. 110 */ 111 112 ompic_writereg(ompic_base, OMPIC_CTRL(src_cpu), 113 OMPIC_CTRL_IRQ_GEN | 114 OMPIC_CTRL_DST(dst_cpu) | 115 OMPIC_DATA(1)); 116 } 117 } 118 ompic_ipi_handler(int irq,void * dev_id)119 static irqreturn_t ompic_ipi_handler(int irq, void *dev_id) 120 { 121 unsigned int cpu = smp_processor_id(); 122 unsigned long *pending_ops = &per_cpu(ops, cpu); 123 unsigned long ops; 124 125 ompic_writereg(ompic_base, OMPIC_CTRL(cpu), OMPIC_CTRL_IRQ_ACK); 126 while ((ops = xchg(pending_ops, 0)) != 0) { 127 128 /* 129 * On OpenRISC the atomic xchg() call implies a memory 130 * barrier. Otherwise we may need an smp_rmb(); paired 131 * with the write in ompic_raise_softirq. 132 */ 133 134 do { 135 unsigned long ipi_msg; 136 137 ipi_msg = __ffs(ops); 138 ops &= ~(1UL << ipi_msg); 139 140 handle_IPI(ipi_msg); 141 } while (ops); 142 } 143 144 return IRQ_HANDLED; 145 } 146 ompic_of_init(struct device_node * node,struct device_node * parent)147 static int __init ompic_of_init(struct device_node *node, 148 struct device_node *parent) 149 { 150 struct resource res; 151 int irq; 152 int ret; 153 154 /* Validate the DT */ 155 if (ompic_base) { 156 pr_err("ompic: duplicate ompic's are not supported"); 157 return -EEXIST; 158 } 159 160 if (of_address_to_resource(node, 0, &res)) { 161 pr_err("ompic: reg property requires an address and size"); 162 return -EINVAL; 163 } 164 165 if (resource_size(&res) < (num_possible_cpus() * OMPIC_CPUBYTES)) { 166 pr_err("ompic: reg size, currently %d must be at least %d", 167 resource_size(&res), 168 (num_possible_cpus() * OMPIC_CPUBYTES)); 169 return -EINVAL; 170 } 171 172 /* Setup the device */ 173 ompic_base = ioremap(res.start, resource_size(&res)); 174 if (!ompic_base) { 175 pr_err("ompic: unable to map registers"); 176 return -ENOMEM; 177 } 178 179 irq = irq_of_parse_and_map(node, 0); 180 if (irq <= 0) { 181 pr_err("ompic: unable to parse device irq"); 182 ret = -EINVAL; 183 goto out_unmap; 184 } 185 186 ret = request_irq(irq, ompic_ipi_handler, IRQF_PERCPU, 187 "ompic_ipi", NULL); 188 if (ret) 189 goto out_irq_disp; 190 191 set_smp_cross_call(ompic_raise_softirq); 192 193 return 0; 194 195 out_irq_disp: 196 irq_dispose_mapping(irq); 197 out_unmap: 198 iounmap(ompic_base); 199 ompic_base = NULL; 200 return ret; 201 } 202 IRQCHIP_DECLARE(ompic, "openrisc,ompic", ompic_of_init); 203