soc/ti/ti_sci_inta_msi.c

0001 // SPDX-License-Identifier: GPL-2.0
0002 /*
0003  * Texas Instruments' K3 Interrupt Aggregator MSI bus
0004  *
0005  * Copyright (C) 2018-2019 Texas Instruments Incorporated - http://www.ti.com/
0006  *  Lokesh Vutla <lokeshvutla@ti.com>
0007  */
0008
0009 #include <linux/irq.h>
0010 #include <linux/irqdomain.h>
0011 #include <linux/msi.h>
0012 #include <linux/of_address.h>
0013 #include <linux/of_device.h>
0014 #include <linux/of_irq.h>
0015 #include <linux/soc/ti/ti_sci_inta_msi.h>
0016 #include <linux/soc/ti/ti_sci_protocol.h>
0017
0018 static void ti_sci_inta_msi_write_msg(struct irq_data *data,
0019                       struct msi_msg *msg)
0020 {
0021     /* Nothing to do */
0022 }
0023
0024 static void ti_sci_inta_msi_compose_msi_msg(struct irq_data *data,
0025                         struct msi_msg *msg)
0026 {
0027     /* Nothing to do */
0028 }
0029
0030 static void ti_sci_inta_msi_update_chip_ops(struct msi_domain_info *info)
0031 {
0032     struct irq_chip *chip = info->chip;
0033
0034     if (WARN_ON(!chip))
0035         return;
0036
0037     chip->irq_request_resources = irq_chip_request_resources_parent;
0038     chip->irq_release_resources = irq_chip_release_resources_parent;
0039     chip->irq_compose_msi_msg = ti_sci_inta_msi_compose_msi_msg;
0040     chip->irq_write_msi_msg = ti_sci_inta_msi_write_msg;
0041     chip->irq_set_type = irq_chip_set_type_parent;
0042     chip->irq_unmask = irq_chip_unmask_parent;
0043     chip->irq_mask = irq_chip_mask_parent;
0044     chip->irq_ack = irq_chip_ack_parent;
0045 }
0046
0047 struct irq_domain *ti_sci_inta_msi_create_irq_domain(struct fwnode_handle *fwnode,
0048                              struct msi_domain_info *info,
0049                              struct irq_domain *parent)
0050 {
0051     struct irq_domain *domain;
0052
0053     ti_sci_inta_msi_update_chip_ops(info);
0054     info->flags |= MSI_FLAG_FREE_MSI_DESCS;
0055
0056     domain = msi_create_irq_domain(fwnode, info, parent);
0057     if (domain)
0058         irq_domain_update_bus_token(domain, DOMAIN_BUS_TI_SCI_INTA_MSI);
0059
0060     return domain;
0061 }
0062 EXPORT_SYMBOL_GPL(ti_sci_inta_msi_create_irq_domain);
0063
0064 static int ti_sci_inta_msi_alloc_descs(struct device *dev,
0065                        struct ti_sci_resource *res)
0066 {
0067     struct msi_desc msi_desc;
0068     int set, i, count = 0;
0069
0070     memset(&msi_desc, 0, sizeof(msi_desc));
0071     msi_desc.nvec_used = 1;
0072
0073     for (set = 0; set < res->sets; set++) {
0074         for (i = 0; i < res->desc[set].num; i++, count++) {
0075             msi_desc.msi_index = res->desc[set].start + i;
0076             if (msi_add_msi_desc(dev, &msi_desc))
0077                 goto fail;
0078         }
0079
0080         for (i = 0; i < res->desc[set].num_sec; i++, count++) {
0081             msi_desc.msi_index = res->desc[set].start_sec + i;
0082             if (msi_add_msi_desc(dev, &msi_desc))
0083                 goto fail;
0084         }
0085     }
0086     return count;
0087 fail:
0088     msi_free_msi_descs(dev);
0089     return -ENOMEM;
0090 }
0091
0092 int ti_sci_inta_msi_domain_alloc_irqs(struct device *dev,
0093                       struct ti_sci_resource *res)
0094 {
0095     struct platform_device *pdev = to_platform_device(dev);
0096     struct irq_domain *msi_domain;
0097     int ret, nvec;
0098
0099     msi_domain = dev_get_msi_domain(dev);
0100     if (!msi_domain)
0101         return -EINVAL;
0102
0103     if (pdev->id < 0)
0104         return -ENODEV;
0105
0106     ret = msi_setup_device_data(dev);
0107     if (ret)
0108         return ret;
0109
0110     msi_lock_descs(dev);
0111     nvec = ti_sci_inta_msi_alloc_descs(dev, res);
0112     if (nvec <= 0) {
0113         ret = nvec;
0114         goto unlock;
0115     }
0116
0117     ret = msi_domain_alloc_irqs_descs_locked(msi_domain, dev, nvec);
0118     if (ret)
0119         dev_err(dev, "Failed to allocate IRQs %d\n", ret);
0120 unlock:
0121     msi_unlock_descs(dev);
0122     return ret;
0123 }
0124 EXPORT_SYMBOL_GPL(ti_sci_inta_msi_domain_alloc_irqs);