196ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R/* 296ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R * drivers/irqchip/irq-crossbar.c 396ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R * 496ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R * Copyright (C) 2013 Texas Instruments Incorporated - http://www.ti.com 596ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R * Author: Sricharan R <r.sricharan@ti.com> 696ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R * 796ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R * This program is free software; you can redistribute it and/or modify 896ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R * it under the terms of the GNU General Public License version 2 as 996ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R * published by the Free Software Foundation. 1096ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R * 1196ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R */ 1296ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R#include <linux/err.h> 1396ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R#include <linux/io.h> 1496ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R#include <linux/of_address.h> 1596ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R#include <linux/of_irq.h> 1696ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R#include <linux/slab.h> 1796ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R#include <linux/irqchip/arm-gic.h> 184dbf45e3c2f3acfd2096cb6a731d159492ddca99Nishanth Menon#include <linux/irqchip/irq-crossbar.h> 1996ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R 2096ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R#define IRQ_FREE -1 211d50d2ce6337724d30055bdbe082236cc86e6785Nishanth Menon#define IRQ_RESERVED -2 2264e0f8ba5cae74471f72e0cb218c67915e365f47Nishanth Menon#define IRQ_SKIP -3 2396ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R#define GIC_IRQ_START 32 2496ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R 25e30ef8abb383903f2b7e1bced971b98fd30cafc3Nishanth Menon/** 26e30ef8abb383903f2b7e1bced971b98fd30cafc3Nishanth Menon * struct crossbar_device - crossbar device description 2796ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R * @int_max: maximum number of supported interrupts 28a35057d1dcb11ae67c9347ef7987cf65ac743c36Nishanth Menon * @safe_map: safe default value to initialize the crossbar 292f7d2fb71dd0c14f9c0fe66f2ed7b4685fa745e2Nishanth Menon * @max_crossbar_sources: Maximum number of crossbar sources 3096ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R * @irq_map: array of interrupts to crossbar number mapping 3196ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R * @crossbar_base: crossbar base address 3296ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R * @register_offsets: offsets for each irq number 33e30ef8abb383903f2b7e1bced971b98fd30cafc3Nishanth Menon * @write: register write function pointer 3496ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R */ 3596ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan Rstruct crossbar_device { 3696ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R uint int_max; 37a35057d1dcb11ae67c9347ef7987cf65ac743c36Nishanth Menon uint safe_map; 382f7d2fb71dd0c14f9c0fe66f2ed7b4685fa745e2Nishanth Menon uint max_crossbar_sources; 3996ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R uint *irq_map; 4096ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R void __iomem *crossbar_base; 4196ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R int *register_offsets; 42a35057d1dcb11ae67c9347ef7987cf65ac743c36Nishanth Menon void (*write)(int, int); 4396ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R}; 4496ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R 4596ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan Rstatic struct crossbar_device *cb; 4696ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R 4796ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan Rstatic inline void crossbar_writel(int irq_no, int cb_no) 4896ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R{ 4996ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R writel(cb_no, cb->crossbar_base + cb->register_offsets[irq_no]); 5096ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R} 5196ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R 5296ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan Rstatic inline void crossbar_writew(int irq_no, int cb_no) 5396ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R{ 5496ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R writew(cb_no, cb->crossbar_base + cb->register_offsets[irq_no]); 5596ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R} 5696ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R 5796ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan Rstatic inline void crossbar_writeb(int irq_no, int cb_no) 5896ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R{ 5996ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R writeb(cb_no, cb->crossbar_base + cb->register_offsets[irq_no]); 6096ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R} 6196ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R 626f16fc878a51572a998655e5ef1c396cb269648dNishanth Menonstatic inline int get_prev_map_irq(int cb_no) 636f16fc878a51572a998655e5ef1c396cb269648dNishanth Menon{ 646f16fc878a51572a998655e5ef1c396cb269648dNishanth Menon int i; 656f16fc878a51572a998655e5ef1c396cb269648dNishanth Menon 66ddee0fb46d26174e71ee1df225b9f9feaff05e10Nishanth Menon for (i = cb->int_max - 1; i >= 0; i--) 676f16fc878a51572a998655e5ef1c396cb269648dNishanth Menon if (cb->irq_map[i] == cb_no) 686f16fc878a51572a998655e5ef1c396cb269648dNishanth Menon return i; 696f16fc878a51572a998655e5ef1c396cb269648dNishanth Menon 706f16fc878a51572a998655e5ef1c396cb269648dNishanth Menon return -ENODEV; 716f16fc878a51572a998655e5ef1c396cb269648dNishanth Menon} 726f16fc878a51572a998655e5ef1c396cb269648dNishanth Menon 7396ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan Rstatic inline int allocate_free_irq(int cb_no) 7496ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R{ 7596ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R int i; 7696ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R 77ddee0fb46d26174e71ee1df225b9f9feaff05e10Nishanth Menon for (i = cb->int_max - 1; i >= 0; i--) { 7896ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R if (cb->irq_map[i] == IRQ_FREE) { 7996ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R cb->irq_map[i] = cb_no; 8096ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R return i; 8196ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R } 8296ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R } 8396ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R 8496ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R return -ENODEV; 8596ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R} 8696ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R 8729918b6790d92456cab87ff41a01224e0882d04aNishanth Menonstatic inline bool needs_crossbar_write(irq_hw_number_t hw) 8829918b6790d92456cab87ff41a01224e0882d04aNishanth Menon{ 89d360892d37b5d0e82595001c4be6d49311e2c265Nishanth Menon int cb_no; 90d360892d37b5d0e82595001c4be6d49311e2c265Nishanth Menon 91d360892d37b5d0e82595001c4be6d49311e2c265Nishanth Menon if (hw > GIC_IRQ_START) { 92d360892d37b5d0e82595001c4be6d49311e2c265Nishanth Menon cb_no = cb->irq_map[hw - GIC_IRQ_START]; 93d360892d37b5d0e82595001c4be6d49311e2c265Nishanth Menon if (cb_no != IRQ_RESERVED && cb_no != IRQ_SKIP) 94d360892d37b5d0e82595001c4be6d49311e2c265Nishanth Menon return true; 95d360892d37b5d0e82595001c4be6d49311e2c265Nishanth Menon } 9629918b6790d92456cab87ff41a01224e0882d04aNishanth Menon 9729918b6790d92456cab87ff41a01224e0882d04aNishanth Menon return false; 9829918b6790d92456cab87ff41a01224e0882d04aNishanth Menon} 9929918b6790d92456cab87ff41a01224e0882d04aNishanth Menon 10096ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan Rstatic int crossbar_domain_map(struct irq_domain *d, unsigned int irq, 10196ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R irq_hw_number_t hw) 10296ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R{ 10329918b6790d92456cab87ff41a01224e0882d04aNishanth Menon if (needs_crossbar_write(hw)) 10429918b6790d92456cab87ff41a01224e0882d04aNishanth Menon cb->write(hw - GIC_IRQ_START, cb->irq_map[hw - GIC_IRQ_START]); 10529918b6790d92456cab87ff41a01224e0882d04aNishanth Menon 10696ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R return 0; 10796ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R} 10896ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R 1098b09a45dc12f83f2312a47f0f0087ec4004ebaccSricharan R/** 1108b09a45dc12f83f2312a47f0f0087ec4004ebaccSricharan R * crossbar_domain_unmap - unmap a crossbar<->irq connection 1118b09a45dc12f83f2312a47f0f0087ec4004ebaccSricharan R * @d: domain of irq to unmap 1128b09a45dc12f83f2312a47f0f0087ec4004ebaccSricharan R * @irq: virq number 1138b09a45dc12f83f2312a47f0f0087ec4004ebaccSricharan R * 1148b09a45dc12f83f2312a47f0f0087ec4004ebaccSricharan R * We do not maintain a use count of total number of map/unmap 1158b09a45dc12f83f2312a47f0f0087ec4004ebaccSricharan R * calls for a particular irq to find out if a irq can be really 1168b09a45dc12f83f2312a47f0f0087ec4004ebaccSricharan R * unmapped. This is because unmap is called during irq_dispose_mapping(irq), 1178b09a45dc12f83f2312a47f0f0087ec4004ebaccSricharan R * after which irq is anyways unusable. So an explicit map has to be called 1188b09a45dc12f83f2312a47f0f0087ec4004ebaccSricharan R * after that. 1198b09a45dc12f83f2312a47f0f0087ec4004ebaccSricharan R */ 12096ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan Rstatic void crossbar_domain_unmap(struct irq_domain *d, unsigned int irq) 12196ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R{ 12296ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R irq_hw_number_t hw = irq_get_irq_data(irq)->hwirq; 12396ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R 12429918b6790d92456cab87ff41a01224e0882d04aNishanth Menon if (needs_crossbar_write(hw)) { 12596ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R cb->irq_map[hw - GIC_IRQ_START] = IRQ_FREE; 126a35057d1dcb11ae67c9347ef7987cf65ac743c36Nishanth Menon cb->write(hw - GIC_IRQ_START, cb->safe_map); 127a35057d1dcb11ae67c9347ef7987cf65ac743c36Nishanth Menon } 12896ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R} 12996ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R 13096ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan Rstatic int crossbar_domain_xlate(struct irq_domain *d, 13196ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R struct device_node *controller, 13296ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R const u32 *intspec, unsigned int intsize, 13396ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R unsigned long *out_hwirq, 13496ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R unsigned int *out_type) 13596ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R{ 136d4922a95a70f0c8c5e45e22af629a5b5f370b867Nishanth Menon int ret; 1372f7d2fb71dd0c14f9c0fe66f2ed7b4685fa745e2Nishanth Menon int req_num = intspec[1]; 138d360892d37b5d0e82595001c4be6d49311e2c265Nishanth Menon int direct_map_num; 13996ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R 1402f7d2fb71dd0c14f9c0fe66f2ed7b4685fa745e2Nishanth Menon if (req_num >= cb->max_crossbar_sources) { 141d360892d37b5d0e82595001c4be6d49311e2c265Nishanth Menon direct_map_num = req_num - cb->max_crossbar_sources; 142d360892d37b5d0e82595001c4be6d49311e2c265Nishanth Menon if (direct_map_num < cb->int_max) { 143d360892d37b5d0e82595001c4be6d49311e2c265Nishanth Menon ret = cb->irq_map[direct_map_num]; 144d360892d37b5d0e82595001c4be6d49311e2c265Nishanth Menon if (ret == IRQ_RESERVED || ret == IRQ_SKIP) { 145d360892d37b5d0e82595001c4be6d49311e2c265Nishanth Menon /* We use the interrupt num as h/w irq num */ 146d360892d37b5d0e82595001c4be6d49311e2c265Nishanth Menon ret = direct_map_num; 147d360892d37b5d0e82595001c4be6d49311e2c265Nishanth Menon goto found; 148d360892d37b5d0e82595001c4be6d49311e2c265Nishanth Menon } 149d360892d37b5d0e82595001c4be6d49311e2c265Nishanth Menon } 150d360892d37b5d0e82595001c4be6d49311e2c265Nishanth Menon 1512f7d2fb71dd0c14f9c0fe66f2ed7b4685fa745e2Nishanth Menon pr_err("%s: requested crossbar number %d > max %d\n", 1522f7d2fb71dd0c14f9c0fe66f2ed7b4685fa745e2Nishanth Menon __func__, req_num, cb->max_crossbar_sources); 1532f7d2fb71dd0c14f9c0fe66f2ed7b4685fa745e2Nishanth Menon return -EINVAL; 1542f7d2fb71dd0c14f9c0fe66f2ed7b4685fa745e2Nishanth Menon } 1552f7d2fb71dd0c14f9c0fe66f2ed7b4685fa745e2Nishanth Menon 1562f7d2fb71dd0c14f9c0fe66f2ed7b4685fa745e2Nishanth Menon ret = get_prev_map_irq(req_num); 157d4922a95a70f0c8c5e45e22af629a5b5f370b867Nishanth Menon if (ret >= 0) 1586f16fc878a51572a998655e5ef1c396cb269648dNishanth Menon goto found; 1596f16fc878a51572a998655e5ef1c396cb269648dNishanth Menon 1602f7d2fb71dd0c14f9c0fe66f2ed7b4685fa745e2Nishanth Menon ret = allocate_free_irq(req_num); 16196ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R 162d4922a95a70f0c8c5e45e22af629a5b5f370b867Nishanth Menon if (ret < 0) 16396ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R return ret; 16496ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R 1656f16fc878a51572a998655e5ef1c396cb269648dNishanth Menonfound: 16696ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R *out_hwirq = ret + GIC_IRQ_START; 16796ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R return 0; 16896ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R} 16996ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R 1704dbf45e3c2f3acfd2096cb6a731d159492ddca99Nishanth Menonstatic const struct irq_domain_ops routable_irq_domain_ops = { 17196ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R .map = crossbar_domain_map, 17296ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R .unmap = crossbar_domain_unmap, 17396ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R .xlate = crossbar_domain_xlate 17496ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R}; 17596ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R 17696ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan Rstatic int __init crossbar_of_init(struct device_node *node) 17796ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R{ 178edb442def98c3c64acc316b6b1a64791c138ab07Nishanth Menon int i, size, max = 0, reserved = 0, entry; 17996ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R const __be32 *irqsr; 180edb442def98c3c64acc316b6b1a64791c138ab07Nishanth Menon int ret = -ENOMEM; 18196ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R 1823894e9e82dfdc87fa35dc7976e0472d220228826Dan Carpenter cb = kzalloc(sizeof(*cb), GFP_KERNEL); 18396ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R 18496ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R if (!cb) 185edb442def98c3c64acc316b6b1a64791c138ab07Nishanth Menon return ret; 18696ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R 18796ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R cb->crossbar_base = of_iomap(node, 0); 18896ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R if (!cb->crossbar_base) 1893c44d5151246947442f2fe8eede842e3f76dd2f1Nishanth Menon goto err_cb; 19096ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R 1912f7d2fb71dd0c14f9c0fe66f2ed7b4685fa745e2Nishanth Menon of_property_read_u32(node, "ti,max-crossbar-sources", 1922f7d2fb71dd0c14f9c0fe66f2ed7b4685fa745e2Nishanth Menon &cb->max_crossbar_sources); 1932f7d2fb71dd0c14f9c0fe66f2ed7b4685fa745e2Nishanth Menon if (!cb->max_crossbar_sources) { 1942f7d2fb71dd0c14f9c0fe66f2ed7b4685fa745e2Nishanth Menon pr_err("missing 'ti,max-crossbar-sources' property\n"); 1952f7d2fb71dd0c14f9c0fe66f2ed7b4685fa745e2Nishanth Menon ret = -EINVAL; 1962f7d2fb71dd0c14f9c0fe66f2ed7b4685fa745e2Nishanth Menon goto err_base; 1972f7d2fb71dd0c14f9c0fe66f2ed7b4685fa745e2Nishanth Menon } 1982f7d2fb71dd0c14f9c0fe66f2ed7b4685fa745e2Nishanth Menon 19996ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R of_property_read_u32(node, "ti,max-irqs", &max); 200edb442def98c3c64acc316b6b1a64791c138ab07Nishanth Menon if (!max) { 201edb442def98c3c64acc316b6b1a64791c138ab07Nishanth Menon pr_err("missing 'ti,max-irqs' property\n"); 202edb442def98c3c64acc316b6b1a64791c138ab07Nishanth Menon ret = -EINVAL; 2033c44d5151246947442f2fe8eede842e3f76dd2f1Nishanth Menon goto err_base; 204edb442def98c3c64acc316b6b1a64791c138ab07Nishanth Menon } 2054dbf45e3c2f3acfd2096cb6a731d159492ddca99Nishanth Menon cb->irq_map = kcalloc(max, sizeof(int), GFP_KERNEL); 20696ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R if (!cb->irq_map) 2073c44d5151246947442f2fe8eede842e3f76dd2f1Nishanth Menon goto err_base; 20896ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R 20996ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R cb->int_max = max; 21096ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R 21196ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R for (i = 0; i < max; i++) 21296ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R cb->irq_map[i] = IRQ_FREE; 21396ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R 21496ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R /* Get and mark reserved irqs */ 21596ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R irqsr = of_get_property(node, "ti,irqs-reserved", &size); 21696ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R if (irqsr) { 21796ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R size /= sizeof(__be32); 21896ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R 21996ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R for (i = 0; i < size; i++) { 22096ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R of_property_read_u32_index(node, 22196ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R "ti,irqs-reserved", 22296ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R i, &entry); 223702f7e36f74254e3e9c013eb969663433885cea7Dan Carpenter if (entry >= max) { 22496ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R pr_err("Invalid reserved entry\n"); 225edb442def98c3c64acc316b6b1a64791c138ab07Nishanth Menon ret = -EINVAL; 2263c44d5151246947442f2fe8eede842e3f76dd2f1Nishanth Menon goto err_irq_map; 22796ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R } 2281d50d2ce6337724d30055bdbe082236cc86e6785Nishanth Menon cb->irq_map[entry] = IRQ_RESERVED; 22996ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R } 23096ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R } 23196ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R 23264e0f8ba5cae74471f72e0cb218c67915e365f47Nishanth Menon /* Skip irqs hardwired to bypass the crossbar */ 23364e0f8ba5cae74471f72e0cb218c67915e365f47Nishanth Menon irqsr = of_get_property(node, "ti,irqs-skip", &size); 23464e0f8ba5cae74471f72e0cb218c67915e365f47Nishanth Menon if (irqsr) { 23564e0f8ba5cae74471f72e0cb218c67915e365f47Nishanth Menon size /= sizeof(__be32); 23664e0f8ba5cae74471f72e0cb218c67915e365f47Nishanth Menon 23764e0f8ba5cae74471f72e0cb218c67915e365f47Nishanth Menon for (i = 0; i < size; i++) { 23864e0f8ba5cae74471f72e0cb218c67915e365f47Nishanth Menon of_property_read_u32_index(node, 23964e0f8ba5cae74471f72e0cb218c67915e365f47Nishanth Menon "ti,irqs-skip", 24064e0f8ba5cae74471f72e0cb218c67915e365f47Nishanth Menon i, &entry); 241702f7e36f74254e3e9c013eb969663433885cea7Dan Carpenter if (entry >= max) { 24264e0f8ba5cae74471f72e0cb218c67915e365f47Nishanth Menon pr_err("Invalid skip entry\n"); 24364e0f8ba5cae74471f72e0cb218c67915e365f47Nishanth Menon ret = -EINVAL; 2443c44d5151246947442f2fe8eede842e3f76dd2f1Nishanth Menon goto err_irq_map; 24564e0f8ba5cae74471f72e0cb218c67915e365f47Nishanth Menon } 24664e0f8ba5cae74471f72e0cb218c67915e365f47Nishanth Menon cb->irq_map[entry] = IRQ_SKIP; 24764e0f8ba5cae74471f72e0cb218c67915e365f47Nishanth Menon } 24864e0f8ba5cae74471f72e0cb218c67915e365f47Nishanth Menon } 24964e0f8ba5cae74471f72e0cb218c67915e365f47Nishanth Menon 25064e0f8ba5cae74471f72e0cb218c67915e365f47Nishanth Menon 2514dbf45e3c2f3acfd2096cb6a731d159492ddca99Nishanth Menon cb->register_offsets = kcalloc(max, sizeof(int), GFP_KERNEL); 25296ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R if (!cb->register_offsets) 2533c44d5151246947442f2fe8eede842e3f76dd2f1Nishanth Menon goto err_irq_map; 25496ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R 25596ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R of_property_read_u32(node, "ti,reg-size", &size); 25696ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R 25796ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R switch (size) { 25896ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R case 1: 25996ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R cb->write = crossbar_writeb; 26096ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R break; 26196ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R case 2: 26296ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R cb->write = crossbar_writew; 26396ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R break; 26496ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R case 4: 26596ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R cb->write = crossbar_writel; 26696ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R break; 26796ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R default: 26896ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R pr_err("Invalid reg-size property\n"); 269edb442def98c3c64acc316b6b1a64791c138ab07Nishanth Menon ret = -EINVAL; 2703c44d5151246947442f2fe8eede842e3f76dd2f1Nishanth Menon goto err_reg_offset; 27196ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R break; 27296ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R } 27396ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R 27496ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R /* 27596ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R * Register offsets are not linear because of the 27696ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R * reserved irqs. so find and store the offsets once. 27796ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R */ 27896ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R for (i = 0; i < max; i++) { 2791d50d2ce6337724d30055bdbe082236cc86e6785Nishanth Menon if (cb->irq_map[i] == IRQ_RESERVED) 28096ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R continue; 28196ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R 28296ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R cb->register_offsets[i] = reserved; 28396ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R reserved += size; 28496ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R } 28596ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R 286a35057d1dcb11ae67c9347ef7987cf65ac743c36Nishanth Menon of_property_read_u32(node, "ti,irqs-safe-map", &cb->safe_map); 287a35057d1dcb11ae67c9347ef7987cf65ac743c36Nishanth Menon /* Initialize the crossbar with safe map to start with */ 288a35057d1dcb11ae67c9347ef7987cf65ac743c36Nishanth Menon for (i = 0; i < max; i++) { 289a35057d1dcb11ae67c9347ef7987cf65ac743c36Nishanth Menon if (cb->irq_map[i] == IRQ_RESERVED || 290a35057d1dcb11ae67c9347ef7987cf65ac743c36Nishanth Menon cb->irq_map[i] == IRQ_SKIP) 291a35057d1dcb11ae67c9347ef7987cf65ac743c36Nishanth Menon continue; 292a35057d1dcb11ae67c9347ef7987cf65ac743c36Nishanth Menon 293a35057d1dcb11ae67c9347ef7987cf65ac743c36Nishanth Menon cb->write(i, cb->safe_map); 294a35057d1dcb11ae67c9347ef7987cf65ac743c36Nishanth Menon } 295a35057d1dcb11ae67c9347ef7987cf65ac743c36Nishanth Menon 29696ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R register_routable_domain_ops(&routable_irq_domain_ops); 29796ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R return 0; 29896ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R 2993c44d5151246947442f2fe8eede842e3f76dd2f1Nishanth Menonerr_reg_offset: 30096ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R kfree(cb->register_offsets); 3013c44d5151246947442f2fe8eede842e3f76dd2f1Nishanth Menonerr_irq_map: 30296ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R kfree(cb->irq_map); 3033c44d5151246947442f2fe8eede842e3f76dd2f1Nishanth Menonerr_base: 30496ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R iounmap(cb->crossbar_base); 3053c44d5151246947442f2fe8eede842e3f76dd2f1Nishanth Menonerr_cb: 30696ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R kfree(cb); 30799e37d0ea607623f286b4841cc355e65b297170cSricharan R 30899e37d0ea607623f286b4841cc355e65b297170cSricharan R cb = NULL; 309edb442def98c3c64acc316b6b1a64791c138ab07Nishanth Menon return ret; 31096ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R} 31196ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R 31296ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan Rstatic const struct of_device_id crossbar_match[] __initconst = { 31396ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R { .compatible = "ti,irq-crossbar" }, 31496ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R {} 31596ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R}; 31696ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R 31796ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan Rint __init irqcrossbar_init(void) 31896ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R{ 31996ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R struct device_node *np; 32096ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R np = of_find_matching_node(NULL, crossbar_match); 32196ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R if (!np) 32296ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R return -ENODEV; 32396ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R 32496ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R crossbar_of_init(np); 32596ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R return 0; 32696ca848ef7ea1be7e92d1cceb34ef3aa86053828Sricharan R} 327