162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * Cell Internal Interrupt Controller 462306a36Sopenharmony_ci * 562306a36Sopenharmony_ci * Copyright (C) 2006 Benjamin Herrenschmidt (benh@kernel.crashing.org) 662306a36Sopenharmony_ci * IBM, Corp. 762306a36Sopenharmony_ci * 862306a36Sopenharmony_ci * (C) Copyright IBM Deutschland Entwicklung GmbH 2005 962306a36Sopenharmony_ci * 1062306a36Sopenharmony_ci * Author: Arnd Bergmann <arndb@de.ibm.com> 1162306a36Sopenharmony_ci * 1262306a36Sopenharmony_ci * TODO: 1362306a36Sopenharmony_ci * - Fix various assumptions related to HW CPU numbers vs. linux CPU numbers 1462306a36Sopenharmony_ci * vs node numbers in the setup code 1562306a36Sopenharmony_ci * - Implement proper handling of maxcpus=1/2 (that is, routing of irqs from 1662306a36Sopenharmony_ci * a non-active node to the active node) 1762306a36Sopenharmony_ci */ 1862306a36Sopenharmony_ci 1962306a36Sopenharmony_ci#include <linux/interrupt.h> 2062306a36Sopenharmony_ci#include <linux/irq.h> 2162306a36Sopenharmony_ci#include <linux/irqdomain.h> 2262306a36Sopenharmony_ci#include <linux/export.h> 2362306a36Sopenharmony_ci#include <linux/percpu.h> 2462306a36Sopenharmony_ci#include <linux/types.h> 2562306a36Sopenharmony_ci#include <linux/ioport.h> 2662306a36Sopenharmony_ci#include <linux/kernel_stat.h> 2762306a36Sopenharmony_ci#include <linux/pgtable.h> 2862306a36Sopenharmony_ci#include <linux/of_address.h> 2962306a36Sopenharmony_ci 3062306a36Sopenharmony_ci#include <asm/io.h> 3162306a36Sopenharmony_ci#include <asm/ptrace.h> 3262306a36Sopenharmony_ci#include <asm/machdep.h> 3362306a36Sopenharmony_ci#include <asm/cell-regs.h> 3462306a36Sopenharmony_ci 3562306a36Sopenharmony_ci#include "interrupt.h" 3662306a36Sopenharmony_ci 3762306a36Sopenharmony_cistruct iic { 3862306a36Sopenharmony_ci struct cbe_iic_thread_regs __iomem *regs; 3962306a36Sopenharmony_ci u8 target_id; 4062306a36Sopenharmony_ci u8 eoi_stack[16]; 4162306a36Sopenharmony_ci int eoi_ptr; 4262306a36Sopenharmony_ci struct device_node *node; 4362306a36Sopenharmony_ci}; 4462306a36Sopenharmony_ci 4562306a36Sopenharmony_cistatic DEFINE_PER_CPU(struct iic, cpu_iic); 4662306a36Sopenharmony_ci#define IIC_NODE_COUNT 2 4762306a36Sopenharmony_cistatic struct irq_domain *iic_host; 4862306a36Sopenharmony_ci 4962306a36Sopenharmony_ci/* Convert between "pending" bits and hw irq number */ 5062306a36Sopenharmony_cistatic irq_hw_number_t iic_pending_to_hwnum(struct cbe_iic_pending_bits bits) 5162306a36Sopenharmony_ci{ 5262306a36Sopenharmony_ci unsigned char unit = bits.source & 0xf; 5362306a36Sopenharmony_ci unsigned char node = bits.source >> 4; 5462306a36Sopenharmony_ci unsigned char class = bits.class & 3; 5562306a36Sopenharmony_ci 5662306a36Sopenharmony_ci /* Decode IPIs */ 5762306a36Sopenharmony_ci if (bits.flags & CBE_IIC_IRQ_IPI) 5862306a36Sopenharmony_ci return IIC_IRQ_TYPE_IPI | (bits.prio >> 4); 5962306a36Sopenharmony_ci else 6062306a36Sopenharmony_ci return (node << IIC_IRQ_NODE_SHIFT) | (class << 4) | unit; 6162306a36Sopenharmony_ci} 6262306a36Sopenharmony_ci 6362306a36Sopenharmony_cistatic void iic_mask(struct irq_data *d) 6462306a36Sopenharmony_ci{ 6562306a36Sopenharmony_ci} 6662306a36Sopenharmony_ci 6762306a36Sopenharmony_cistatic void iic_unmask(struct irq_data *d) 6862306a36Sopenharmony_ci{ 6962306a36Sopenharmony_ci} 7062306a36Sopenharmony_ci 7162306a36Sopenharmony_cistatic void iic_eoi(struct irq_data *d) 7262306a36Sopenharmony_ci{ 7362306a36Sopenharmony_ci struct iic *iic = this_cpu_ptr(&cpu_iic); 7462306a36Sopenharmony_ci out_be64(&iic->regs->prio, iic->eoi_stack[--iic->eoi_ptr]); 7562306a36Sopenharmony_ci BUG_ON(iic->eoi_ptr < 0); 7662306a36Sopenharmony_ci} 7762306a36Sopenharmony_ci 7862306a36Sopenharmony_cistatic struct irq_chip iic_chip = { 7962306a36Sopenharmony_ci .name = "CELL-IIC", 8062306a36Sopenharmony_ci .irq_mask = iic_mask, 8162306a36Sopenharmony_ci .irq_unmask = iic_unmask, 8262306a36Sopenharmony_ci .irq_eoi = iic_eoi, 8362306a36Sopenharmony_ci}; 8462306a36Sopenharmony_ci 8562306a36Sopenharmony_ci 8662306a36Sopenharmony_cistatic void iic_ioexc_eoi(struct irq_data *d) 8762306a36Sopenharmony_ci{ 8862306a36Sopenharmony_ci} 8962306a36Sopenharmony_ci 9062306a36Sopenharmony_cistatic void iic_ioexc_cascade(struct irq_desc *desc) 9162306a36Sopenharmony_ci{ 9262306a36Sopenharmony_ci struct irq_chip *chip = irq_desc_get_chip(desc); 9362306a36Sopenharmony_ci struct cbe_iic_regs __iomem *node_iic = 9462306a36Sopenharmony_ci (void __iomem *)irq_desc_get_handler_data(desc); 9562306a36Sopenharmony_ci unsigned int irq = irq_desc_get_irq(desc); 9662306a36Sopenharmony_ci unsigned int base = (irq & 0xffffff00) | IIC_IRQ_TYPE_IOEXC; 9762306a36Sopenharmony_ci unsigned long bits, ack; 9862306a36Sopenharmony_ci int cascade; 9962306a36Sopenharmony_ci 10062306a36Sopenharmony_ci for (;;) { 10162306a36Sopenharmony_ci bits = in_be64(&node_iic->iic_is); 10262306a36Sopenharmony_ci if (bits == 0) 10362306a36Sopenharmony_ci break; 10462306a36Sopenharmony_ci /* pre-ack edge interrupts */ 10562306a36Sopenharmony_ci ack = bits & IIC_ISR_EDGE_MASK; 10662306a36Sopenharmony_ci if (ack) 10762306a36Sopenharmony_ci out_be64(&node_iic->iic_is, ack); 10862306a36Sopenharmony_ci /* handle them */ 10962306a36Sopenharmony_ci for (cascade = 63; cascade >= 0; cascade--) 11062306a36Sopenharmony_ci if (bits & (0x8000000000000000UL >> cascade)) 11162306a36Sopenharmony_ci generic_handle_domain_irq(iic_host, 11262306a36Sopenharmony_ci base | cascade); 11362306a36Sopenharmony_ci /* post-ack level interrupts */ 11462306a36Sopenharmony_ci ack = bits & ~IIC_ISR_EDGE_MASK; 11562306a36Sopenharmony_ci if (ack) 11662306a36Sopenharmony_ci out_be64(&node_iic->iic_is, ack); 11762306a36Sopenharmony_ci } 11862306a36Sopenharmony_ci chip->irq_eoi(&desc->irq_data); 11962306a36Sopenharmony_ci} 12062306a36Sopenharmony_ci 12162306a36Sopenharmony_ci 12262306a36Sopenharmony_cistatic struct irq_chip iic_ioexc_chip = { 12362306a36Sopenharmony_ci .name = "CELL-IOEX", 12462306a36Sopenharmony_ci .irq_mask = iic_mask, 12562306a36Sopenharmony_ci .irq_unmask = iic_unmask, 12662306a36Sopenharmony_ci .irq_eoi = iic_ioexc_eoi, 12762306a36Sopenharmony_ci}; 12862306a36Sopenharmony_ci 12962306a36Sopenharmony_ci/* Get an IRQ number from the pending state register of the IIC */ 13062306a36Sopenharmony_cistatic unsigned int iic_get_irq(void) 13162306a36Sopenharmony_ci{ 13262306a36Sopenharmony_ci struct cbe_iic_pending_bits pending; 13362306a36Sopenharmony_ci struct iic *iic; 13462306a36Sopenharmony_ci unsigned int virq; 13562306a36Sopenharmony_ci 13662306a36Sopenharmony_ci iic = this_cpu_ptr(&cpu_iic); 13762306a36Sopenharmony_ci *(unsigned long *) &pending = 13862306a36Sopenharmony_ci in_be64((u64 __iomem *) &iic->regs->pending_destr); 13962306a36Sopenharmony_ci if (!(pending.flags & CBE_IIC_IRQ_VALID)) 14062306a36Sopenharmony_ci return 0; 14162306a36Sopenharmony_ci virq = irq_linear_revmap(iic_host, iic_pending_to_hwnum(pending)); 14262306a36Sopenharmony_ci if (!virq) 14362306a36Sopenharmony_ci return 0; 14462306a36Sopenharmony_ci iic->eoi_stack[++iic->eoi_ptr] = pending.prio; 14562306a36Sopenharmony_ci BUG_ON(iic->eoi_ptr > 15); 14662306a36Sopenharmony_ci return virq; 14762306a36Sopenharmony_ci} 14862306a36Sopenharmony_ci 14962306a36Sopenharmony_civoid iic_setup_cpu(void) 15062306a36Sopenharmony_ci{ 15162306a36Sopenharmony_ci out_be64(&this_cpu_ptr(&cpu_iic)->regs->prio, 0xff); 15262306a36Sopenharmony_ci} 15362306a36Sopenharmony_ci 15462306a36Sopenharmony_ciu8 iic_get_target_id(int cpu) 15562306a36Sopenharmony_ci{ 15662306a36Sopenharmony_ci return per_cpu(cpu_iic, cpu).target_id; 15762306a36Sopenharmony_ci} 15862306a36Sopenharmony_ci 15962306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(iic_get_target_id); 16062306a36Sopenharmony_ci 16162306a36Sopenharmony_ci#ifdef CONFIG_SMP 16262306a36Sopenharmony_ci 16362306a36Sopenharmony_ci/* Use the highest interrupt priorities for IPI */ 16462306a36Sopenharmony_cistatic inline int iic_msg_to_irq(int msg) 16562306a36Sopenharmony_ci{ 16662306a36Sopenharmony_ci return IIC_IRQ_TYPE_IPI + 0xf - msg; 16762306a36Sopenharmony_ci} 16862306a36Sopenharmony_ci 16962306a36Sopenharmony_civoid iic_message_pass(int cpu, int msg) 17062306a36Sopenharmony_ci{ 17162306a36Sopenharmony_ci out_be64(&per_cpu(cpu_iic, cpu).regs->generate, (0xf - msg) << 4); 17262306a36Sopenharmony_ci} 17362306a36Sopenharmony_ci 17462306a36Sopenharmony_cistatic void iic_request_ipi(int msg) 17562306a36Sopenharmony_ci{ 17662306a36Sopenharmony_ci int virq; 17762306a36Sopenharmony_ci 17862306a36Sopenharmony_ci virq = irq_create_mapping(iic_host, iic_msg_to_irq(msg)); 17962306a36Sopenharmony_ci if (!virq) { 18062306a36Sopenharmony_ci printk(KERN_ERR 18162306a36Sopenharmony_ci "iic: failed to map IPI %s\n", smp_ipi_name[msg]); 18262306a36Sopenharmony_ci return; 18362306a36Sopenharmony_ci } 18462306a36Sopenharmony_ci 18562306a36Sopenharmony_ci /* 18662306a36Sopenharmony_ci * If smp_request_message_ipi encounters an error it will notify 18762306a36Sopenharmony_ci * the error. If a message is not needed it will return non-zero. 18862306a36Sopenharmony_ci */ 18962306a36Sopenharmony_ci if (smp_request_message_ipi(virq, msg)) 19062306a36Sopenharmony_ci irq_dispose_mapping(virq); 19162306a36Sopenharmony_ci} 19262306a36Sopenharmony_ci 19362306a36Sopenharmony_civoid iic_request_IPIs(void) 19462306a36Sopenharmony_ci{ 19562306a36Sopenharmony_ci iic_request_ipi(PPC_MSG_CALL_FUNCTION); 19662306a36Sopenharmony_ci iic_request_ipi(PPC_MSG_RESCHEDULE); 19762306a36Sopenharmony_ci iic_request_ipi(PPC_MSG_TICK_BROADCAST); 19862306a36Sopenharmony_ci iic_request_ipi(PPC_MSG_NMI_IPI); 19962306a36Sopenharmony_ci} 20062306a36Sopenharmony_ci 20162306a36Sopenharmony_ci#endif /* CONFIG_SMP */ 20262306a36Sopenharmony_ci 20362306a36Sopenharmony_ci 20462306a36Sopenharmony_cistatic int iic_host_match(struct irq_domain *h, struct device_node *node, 20562306a36Sopenharmony_ci enum irq_domain_bus_token bus_token) 20662306a36Sopenharmony_ci{ 20762306a36Sopenharmony_ci return of_device_is_compatible(node, 20862306a36Sopenharmony_ci "IBM,CBEA-Internal-Interrupt-Controller"); 20962306a36Sopenharmony_ci} 21062306a36Sopenharmony_ci 21162306a36Sopenharmony_cistatic int iic_host_map(struct irq_domain *h, unsigned int virq, 21262306a36Sopenharmony_ci irq_hw_number_t hw) 21362306a36Sopenharmony_ci{ 21462306a36Sopenharmony_ci switch (hw & IIC_IRQ_TYPE_MASK) { 21562306a36Sopenharmony_ci case IIC_IRQ_TYPE_IPI: 21662306a36Sopenharmony_ci irq_set_chip_and_handler(virq, &iic_chip, handle_percpu_irq); 21762306a36Sopenharmony_ci break; 21862306a36Sopenharmony_ci case IIC_IRQ_TYPE_IOEXC: 21962306a36Sopenharmony_ci irq_set_chip_and_handler(virq, &iic_ioexc_chip, 22062306a36Sopenharmony_ci handle_edge_eoi_irq); 22162306a36Sopenharmony_ci break; 22262306a36Sopenharmony_ci default: 22362306a36Sopenharmony_ci irq_set_chip_and_handler(virq, &iic_chip, handle_edge_eoi_irq); 22462306a36Sopenharmony_ci } 22562306a36Sopenharmony_ci return 0; 22662306a36Sopenharmony_ci} 22762306a36Sopenharmony_ci 22862306a36Sopenharmony_cistatic int iic_host_xlate(struct irq_domain *h, struct device_node *ct, 22962306a36Sopenharmony_ci const u32 *intspec, unsigned int intsize, 23062306a36Sopenharmony_ci irq_hw_number_t *out_hwirq, unsigned int *out_flags) 23162306a36Sopenharmony_ci 23262306a36Sopenharmony_ci{ 23362306a36Sopenharmony_ci unsigned int node, ext, unit, class; 23462306a36Sopenharmony_ci const u32 *val; 23562306a36Sopenharmony_ci 23662306a36Sopenharmony_ci if (!of_device_is_compatible(ct, 23762306a36Sopenharmony_ci "IBM,CBEA-Internal-Interrupt-Controller")) 23862306a36Sopenharmony_ci return -ENODEV; 23962306a36Sopenharmony_ci if (intsize != 1) 24062306a36Sopenharmony_ci return -ENODEV; 24162306a36Sopenharmony_ci val = of_get_property(ct, "#interrupt-cells", NULL); 24262306a36Sopenharmony_ci if (val == NULL || *val != 1) 24362306a36Sopenharmony_ci return -ENODEV; 24462306a36Sopenharmony_ci 24562306a36Sopenharmony_ci node = intspec[0] >> 24; 24662306a36Sopenharmony_ci ext = (intspec[0] >> 16) & 0xff; 24762306a36Sopenharmony_ci class = (intspec[0] >> 8) & 0xff; 24862306a36Sopenharmony_ci unit = intspec[0] & 0xff; 24962306a36Sopenharmony_ci 25062306a36Sopenharmony_ci /* Check if node is in supported range */ 25162306a36Sopenharmony_ci if (node > 1) 25262306a36Sopenharmony_ci return -EINVAL; 25362306a36Sopenharmony_ci 25462306a36Sopenharmony_ci /* Build up interrupt number, special case for IO exceptions */ 25562306a36Sopenharmony_ci *out_hwirq = (node << IIC_IRQ_NODE_SHIFT); 25662306a36Sopenharmony_ci if (unit == IIC_UNIT_IIC && class == 1) 25762306a36Sopenharmony_ci *out_hwirq |= IIC_IRQ_TYPE_IOEXC | ext; 25862306a36Sopenharmony_ci else 25962306a36Sopenharmony_ci *out_hwirq |= IIC_IRQ_TYPE_NORMAL | 26062306a36Sopenharmony_ci (class << IIC_IRQ_CLASS_SHIFT) | unit; 26162306a36Sopenharmony_ci 26262306a36Sopenharmony_ci /* Dummy flags, ignored by iic code */ 26362306a36Sopenharmony_ci *out_flags = IRQ_TYPE_EDGE_RISING; 26462306a36Sopenharmony_ci 26562306a36Sopenharmony_ci return 0; 26662306a36Sopenharmony_ci} 26762306a36Sopenharmony_ci 26862306a36Sopenharmony_cistatic const struct irq_domain_ops iic_host_ops = { 26962306a36Sopenharmony_ci .match = iic_host_match, 27062306a36Sopenharmony_ci .map = iic_host_map, 27162306a36Sopenharmony_ci .xlate = iic_host_xlate, 27262306a36Sopenharmony_ci}; 27362306a36Sopenharmony_ci 27462306a36Sopenharmony_cistatic void __init init_one_iic(unsigned int hw_cpu, unsigned long addr, 27562306a36Sopenharmony_ci struct device_node *node) 27662306a36Sopenharmony_ci{ 27762306a36Sopenharmony_ci /* XXX FIXME: should locate the linux CPU number from the HW cpu 27862306a36Sopenharmony_ci * number properly. We are lucky for now 27962306a36Sopenharmony_ci */ 28062306a36Sopenharmony_ci struct iic *iic = &per_cpu(cpu_iic, hw_cpu); 28162306a36Sopenharmony_ci 28262306a36Sopenharmony_ci iic->regs = ioremap(addr, sizeof(struct cbe_iic_thread_regs)); 28362306a36Sopenharmony_ci BUG_ON(iic->regs == NULL); 28462306a36Sopenharmony_ci 28562306a36Sopenharmony_ci iic->target_id = ((hw_cpu & 2) << 3) | ((hw_cpu & 1) ? 0xf : 0xe); 28662306a36Sopenharmony_ci iic->eoi_stack[0] = 0xff; 28762306a36Sopenharmony_ci iic->node = of_node_get(node); 28862306a36Sopenharmony_ci out_be64(&iic->regs->prio, 0); 28962306a36Sopenharmony_ci 29062306a36Sopenharmony_ci printk(KERN_INFO "IIC for CPU %d target id 0x%x : %pOF\n", 29162306a36Sopenharmony_ci hw_cpu, iic->target_id, node); 29262306a36Sopenharmony_ci} 29362306a36Sopenharmony_ci 29462306a36Sopenharmony_cistatic int __init setup_iic(void) 29562306a36Sopenharmony_ci{ 29662306a36Sopenharmony_ci struct device_node *dn; 29762306a36Sopenharmony_ci struct resource r0, r1; 29862306a36Sopenharmony_ci unsigned int node, cascade, found = 0; 29962306a36Sopenharmony_ci struct cbe_iic_regs __iomem *node_iic; 30062306a36Sopenharmony_ci const u32 *np; 30162306a36Sopenharmony_ci 30262306a36Sopenharmony_ci for_each_node_by_name(dn, "interrupt-controller") { 30362306a36Sopenharmony_ci if (!of_device_is_compatible(dn, 30462306a36Sopenharmony_ci "IBM,CBEA-Internal-Interrupt-Controller")) 30562306a36Sopenharmony_ci continue; 30662306a36Sopenharmony_ci np = of_get_property(dn, "ibm,interrupt-server-ranges", NULL); 30762306a36Sopenharmony_ci if (np == NULL) { 30862306a36Sopenharmony_ci printk(KERN_WARNING "IIC: CPU association not found\n"); 30962306a36Sopenharmony_ci of_node_put(dn); 31062306a36Sopenharmony_ci return -ENODEV; 31162306a36Sopenharmony_ci } 31262306a36Sopenharmony_ci if (of_address_to_resource(dn, 0, &r0) || 31362306a36Sopenharmony_ci of_address_to_resource(dn, 1, &r1)) { 31462306a36Sopenharmony_ci printk(KERN_WARNING "IIC: Can't resolve addresses\n"); 31562306a36Sopenharmony_ci of_node_put(dn); 31662306a36Sopenharmony_ci return -ENODEV; 31762306a36Sopenharmony_ci } 31862306a36Sopenharmony_ci found++; 31962306a36Sopenharmony_ci init_one_iic(np[0], r0.start, dn); 32062306a36Sopenharmony_ci init_one_iic(np[1], r1.start, dn); 32162306a36Sopenharmony_ci 32262306a36Sopenharmony_ci /* Setup cascade for IO exceptions. XXX cleanup tricks to get 32362306a36Sopenharmony_ci * node vs CPU etc... 32462306a36Sopenharmony_ci * Note that we configure the IIC_IRR here with a hard coded 32562306a36Sopenharmony_ci * priority of 1. We might want to improve that later. 32662306a36Sopenharmony_ci */ 32762306a36Sopenharmony_ci node = np[0] >> 1; 32862306a36Sopenharmony_ci node_iic = cbe_get_cpu_iic_regs(np[0]); 32962306a36Sopenharmony_ci cascade = node << IIC_IRQ_NODE_SHIFT; 33062306a36Sopenharmony_ci cascade |= 1 << IIC_IRQ_CLASS_SHIFT; 33162306a36Sopenharmony_ci cascade |= IIC_UNIT_IIC; 33262306a36Sopenharmony_ci cascade = irq_create_mapping(iic_host, cascade); 33362306a36Sopenharmony_ci if (!cascade) 33462306a36Sopenharmony_ci continue; 33562306a36Sopenharmony_ci /* 33662306a36Sopenharmony_ci * irq_data is a generic pointer that gets passed back 33762306a36Sopenharmony_ci * to us later, so the forced cast is fine. 33862306a36Sopenharmony_ci */ 33962306a36Sopenharmony_ci irq_set_handler_data(cascade, (void __force *)node_iic); 34062306a36Sopenharmony_ci irq_set_chained_handler(cascade, iic_ioexc_cascade); 34162306a36Sopenharmony_ci out_be64(&node_iic->iic_ir, 34262306a36Sopenharmony_ci (1 << 12) /* priority */ | 34362306a36Sopenharmony_ci (node << 4) /* dest node */ | 34462306a36Sopenharmony_ci IIC_UNIT_THREAD_0 /* route them to thread 0 */); 34562306a36Sopenharmony_ci /* Flush pending (make sure it triggers if there is 34662306a36Sopenharmony_ci * anything pending 34762306a36Sopenharmony_ci */ 34862306a36Sopenharmony_ci out_be64(&node_iic->iic_is, 0xfffffffffffffffful); 34962306a36Sopenharmony_ci } 35062306a36Sopenharmony_ci 35162306a36Sopenharmony_ci if (found) 35262306a36Sopenharmony_ci return 0; 35362306a36Sopenharmony_ci else 35462306a36Sopenharmony_ci return -ENODEV; 35562306a36Sopenharmony_ci} 35662306a36Sopenharmony_ci 35762306a36Sopenharmony_civoid __init iic_init_IRQ(void) 35862306a36Sopenharmony_ci{ 35962306a36Sopenharmony_ci /* Setup an irq host data structure */ 36062306a36Sopenharmony_ci iic_host = irq_domain_add_linear(NULL, IIC_SOURCE_COUNT, &iic_host_ops, 36162306a36Sopenharmony_ci NULL); 36262306a36Sopenharmony_ci BUG_ON(iic_host == NULL); 36362306a36Sopenharmony_ci irq_set_default_host(iic_host); 36462306a36Sopenharmony_ci 36562306a36Sopenharmony_ci /* Discover and initialize iics */ 36662306a36Sopenharmony_ci if (setup_iic() < 0) 36762306a36Sopenharmony_ci panic("IIC: Failed to initialize !\n"); 36862306a36Sopenharmony_ci 36962306a36Sopenharmony_ci /* Set master interrupt handling function */ 37062306a36Sopenharmony_ci ppc_md.get_irq = iic_get_irq; 37162306a36Sopenharmony_ci 37262306a36Sopenharmony_ci /* Enable on current CPU */ 37362306a36Sopenharmony_ci iic_setup_cpu(); 37462306a36Sopenharmony_ci} 37562306a36Sopenharmony_ci 37662306a36Sopenharmony_civoid iic_set_interrupt_routing(int cpu, int thread, int priority) 37762306a36Sopenharmony_ci{ 37862306a36Sopenharmony_ci struct cbe_iic_regs __iomem *iic_regs = cbe_get_cpu_iic_regs(cpu); 37962306a36Sopenharmony_ci u64 iic_ir = 0; 38062306a36Sopenharmony_ci int node = cpu >> 1; 38162306a36Sopenharmony_ci 38262306a36Sopenharmony_ci /* Set which node and thread will handle the next interrupt */ 38362306a36Sopenharmony_ci iic_ir |= CBE_IIC_IR_PRIO(priority) | 38462306a36Sopenharmony_ci CBE_IIC_IR_DEST_NODE(node); 38562306a36Sopenharmony_ci if (thread == 0) 38662306a36Sopenharmony_ci iic_ir |= CBE_IIC_IR_DEST_UNIT(CBE_IIC_IR_PT_0); 38762306a36Sopenharmony_ci else 38862306a36Sopenharmony_ci iic_ir |= CBE_IIC_IR_DEST_UNIT(CBE_IIC_IR_PT_1); 38962306a36Sopenharmony_ci out_be64(&iic_regs->iic_ir, iic_ir); 39062306a36Sopenharmony_ci} 391