1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * Texas Instruments' K3 Interrupt Aggregator MSI bus 4 * 5 * Copyright (C) 2018-2019 Texas Instruments Incorporated - http://www.ti.com/ 6 * Lokesh Vutla <lokeshvutla@ti.com> 7 */ 8 9 #include <linux/irq.h> 10 #include <linux/irqdomain.h> 11 #include <linux/msi.h> 12 #include <linux/of.h> 13 #include <linux/of_address.h> 14 #include <linux/of_irq.h> 15 #include <linux/platform_device.h> 16 #include <linux/soc/ti/ti_sci_inta_msi.h> 17 #include <linux/soc/ti/ti_sci_protocol.h> 18 19 static void ti_sci_inta_msi_write_msg(struct irq_data *data, 20 struct msi_msg *msg) 21 { 22 /* Nothing to do */ 23 } 24 25 static void ti_sci_inta_msi_compose_msi_msg(struct irq_data *data, 26 struct msi_msg *msg) 27 { 28 /* Nothing to do */ 29 } 30 31 static void ti_sci_inta_msi_update_chip_ops(struct msi_domain_info *info) 32 { 33 struct irq_chip *chip = info->chip; 34 35 if (WARN_ON(!chip)) 36 return; 37 38 chip->irq_request_resources = irq_chip_request_resources_parent; 39 chip->irq_release_resources = irq_chip_release_resources_parent; 40 chip->irq_compose_msi_msg = ti_sci_inta_msi_compose_msi_msg; 41 chip->irq_write_msi_msg = ti_sci_inta_msi_write_msg; 42 chip->irq_set_type = irq_chip_set_type_parent; 43 chip->irq_unmask = irq_chip_unmask_parent; 44 chip->irq_mask = irq_chip_mask_parent; 45 chip->irq_ack = irq_chip_ack_parent; 46 } 47 48 struct irq_domain *ti_sci_inta_msi_create_irq_domain(struct fwnode_handle *fwnode, 49 struct msi_domain_info *info, 50 struct irq_domain *parent) 51 { 52 struct irq_domain *domain; 53 54 ti_sci_inta_msi_update_chip_ops(info); 55 info->flags |= MSI_FLAG_FREE_MSI_DESCS; 56 57 domain = msi_create_irq_domain(fwnode, info, parent); 58 if (domain) 59 irq_domain_update_bus_token(domain, DOMAIN_BUS_TI_SCI_INTA_MSI); 60 61 return domain; 62 } 63 EXPORT_SYMBOL_GPL(ti_sci_inta_msi_create_irq_domain); 64 65 static int ti_sci_inta_msi_alloc_descs(struct device *dev, 66 struct ti_sci_resource *res) 67 { 68 struct msi_desc msi_desc; 69 int set, i, count = 0; 70 71 memset(&msi_desc, 0, sizeof(msi_desc)); 72 msi_desc.nvec_used = 1; 73 74 for (set = 0; set < res->sets; set++) { 75 for (i = 0; i < res->desc[set].num; i++, count++) { 76 msi_desc.msi_index = res->desc[set].start + i; 77 if (msi_insert_msi_desc(dev, &msi_desc)) 78 goto fail; 79 } 80 81 for (i = 0; i < res->desc[set].num_sec; i++, count++) { 82 msi_desc.msi_index = res->desc[set].start_sec + i; 83 if (msi_insert_msi_desc(dev, &msi_desc)) 84 goto fail; 85 } 86 } 87 return count; 88 fail: 89 msi_free_msi_descs(dev); 90 return -ENOMEM; 91 } 92 93 int ti_sci_inta_msi_domain_alloc_irqs(struct device *dev, 94 struct ti_sci_resource *res) 95 { 96 struct platform_device *pdev = to_platform_device(dev); 97 int ret, nvec; 98 99 if (pdev->id < 0) 100 return -ENODEV; 101 102 ret = msi_setup_device_data(dev); 103 if (ret) 104 return ret; 105 106 msi_lock_descs(dev); 107 nvec = ti_sci_inta_msi_alloc_descs(dev, res); 108 if (nvec <= 0) { 109 ret = nvec; 110 goto unlock; 111 } 112 113 /* Use alloc ALL as it's unclear whether there are gaps in the indices */ 114 ret = msi_domain_alloc_irqs_all_locked(dev, MSI_DEFAULT_DOMAIN, nvec); 115 if (ret) 116 dev_err(dev, "Failed to allocate IRQs %d\n", ret); 117 unlock: 118 msi_unlock_descs(dev); 119 return ret; 120 } 121 EXPORT_SYMBOL_GPL(ti_sci_inta_msi_domain_alloc_irqs); 122