ti_sci_inta_msi.c

  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
 19static void ti_sci_inta_msi_write_msg(struct irq_data *data,
 20				      struct msi_msg *msg)
 21{
 22	/* Nothing to do */
 23}
 24
 25static void ti_sci_inta_msi_compose_msi_msg(struct irq_data *data,
 26					    struct msi_msg *msg)
 27{
 28	/* Nothing to do */
 29}
 30
 31static 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
 48struct 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}
 63EXPORT_SYMBOL_GPL(ti_sci_inta_msi_create_irq_domain);
 64
 65static 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;
 88fail:
 89	msi_free_msi_descs(dev);
 90	return -ENOMEM;
 91}
 92
 93int 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	guard(msi_descs_lock)(dev);
107	nvec = ti_sci_inta_msi_alloc_descs(dev, res);
108	if (nvec <= 0)
109		return nvec;
110
111	/* Use alloc ALL as it's unclear whether there are gaps in the indices */
112	ret = msi_domain_alloc_irqs_all_locked(dev, MSI_DEFAULT_DOMAIN, nvec);
113	if (ret)
114		dev_err(dev, "Failed to allocate IRQs %d\n", ret);
115	return ret;
116}
117EXPORT_SYMBOL_GPL(ti_sci_inta_msi_domain_alloc_irqs);