drivers/irqchip/irq-loongson-pch-msi.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /*
   3  *  Copyright (C) 2020, Jiaxun Yang <jiaxun.yang@flygoat.com>
   4  *  Loongson PCH MSI support
   5  */
   6
   7 #define pr_fmt(fmt) "pch-msi: " fmt
   8
   9 #include <linux/irqchip.h>
  10 #include <linux/msi.h>
  11 #include <linux/of.h>
  12 #include <linux/of_address.h>
  13 #include <linux/of_irq.h>
  14 #include <linux/of_pci.h>
  15 #include <linux/pci.h>
  16 #include <linux/slab.h>
  17
  18 struct pch_msi_data {
  19         struct mutex    msi_map_lock;
  20         phys_addr_t     doorbell;
  21         u32             irq_first;      /* The vector number that MSIs starts */
  22         u32             num_irqs;       /* The number of vectors for MSIs */
  23         unsigned long   *msi_map;
  24 };
  25
  26 static void pch_msi_mask_msi_irq(struct irq_data *d)
  27 {
  28         pci_msi_mask_irq(d);
  29         irq_chip_mask_parent(d);
  30 }
  31
  32 static void pch_msi_unmask_msi_irq(struct irq_data *d)
  33 {
  34         irq_chip_unmask_parent(d);
  35         pci_msi_unmask_irq(d);
  36 }
  37
  38 static struct irq_chip pch_msi_irq_chip = {
  39         .name                   = "PCH PCI MSI",
  40         .irq_mask               = pch_msi_mask_msi_irq,
  41         .irq_unmask             = pch_msi_unmask_msi_irq,
  42         .irq_ack                = irq_chip_ack_parent,
  43         .irq_set_affinity       = irq_chip_set_affinity_parent,
  44 };
  45
  46 static int pch_msi_allocate_hwirq(struct pch_msi_data *priv, int num_req)
  47 {
  48         int first;
  49
  50         mutex_lock(&priv->msi_map_lock);
  51
  52         first = bitmap_find_free_region(priv->msi_map, priv->num_irqs,
  53                                         get_count_order(num_req));
  54         if (first < 0) {
  55                 mutex_unlock(&priv->msi_map_lock);
  56                 return -ENOSPC;
  57         }
  58
  59         mutex_unlock(&priv->msi_map_lock);
  60
  61         return priv->irq_first + first;
  62 }
  63
  64 static void pch_msi_free_hwirq(struct pch_msi_data *priv,
  65                                 int hwirq, int num_req)
  66 {
  67         int first = hwirq - priv->irq_first;
  68
  69         mutex_lock(&priv->msi_map_lock);
  70         bitmap_release_region(priv->msi_map, first, get_count_order(num_req));
  71         mutex_unlock(&priv->msi_map_lock);
  72 }
  73
  74 static void pch_msi_compose_msi_msg(struct irq_data *data,
  75                                         struct msi_msg *msg)
  76 {
  77         struct pch_msi_data *priv = irq_data_get_irq_chip_data(data);
  78
  79         msg->address_hi = upper_32_bits(priv->doorbell);
  80         msg->address_lo = lower_32_bits(priv->doorbell);
  81         msg->data = data->hwirq;
  82 }
  83
  84 static struct msi_domain_info pch_msi_domain_info = {
  85         .flags  = MSI_FLAG_USE_DEF_DOM_OPS | MSI_FLAG_USE_DEF_CHIP_OPS |
  86                   MSI_FLAG_MULTI_PCI_MSI | MSI_FLAG_PCI_MSIX,
  87         .chip   = &pch_msi_irq_chip,
  88 };
  89
  90 static struct irq_chip middle_irq_chip = {
  91         .name                   = "PCH MSI",
  92         .irq_mask               = irq_chip_mask_parent,
  93         .irq_unmask             = irq_chip_unmask_parent,
  94         .irq_ack                = irq_chip_ack_parent,
  95         .irq_set_affinity       = irq_chip_set_affinity_parent,
  96         .irq_compose_msi_msg    = pch_msi_compose_msi_msg,
  97 };
  98
  99 static int pch_msi_parent_domain_alloc(struct irq_domain *domain,
 100                                         unsigned int virq, int hwirq)
 101 {
 102         struct irq_fwspec fwspec;
 103
 104         fwspec.fwnode = domain->parent->fwnode;
 105         fwspec.param_count = 1;
 106         fwspec.param[0] = hwirq;
 107
 108         return irq_domain_alloc_irqs_parent(domain, virq, 1, &fwspec);
 109 }
 110
 111 static int pch_msi_middle_domain_alloc(struct irq_domain *domain,
 112                                            unsigned int virq,
 113                                            unsigned int nr_irqs, void *args)
 114 {
 115         struct pch_msi_data *priv = domain->host_data;
 116         int hwirq, err, i;
 117
 118         hwirq = pch_msi_allocate_hwirq(priv, nr_irqs);
 119         if (hwirq < 0)
 120                 return hwirq;
 121
 122         for (i = 0; i < nr_irqs; i++) {
 123                 err = pch_msi_parent_domain_alloc(domain, virq + i, hwirq + i);
 124                 if (err)
 125                         goto err_hwirq;
 126
 127                 irq_domain_set_hwirq_and_chip(domain, virq + i, hwirq + i,
 128                                               &middle_irq_chip, priv);
 129         }
 130
 131         return 0;
 132
 133 err_hwirq:
 134         pch_msi_free_hwirq(priv, hwirq, nr_irqs);
 135         irq_domain_free_irqs_parent(domain, virq, i - 1);
 136
 137         return err;
 138 }
 139
 140 static void pch_msi_middle_domain_free(struct irq_domain *domain,
 141                                            unsigned int virq,
 142                                            unsigned int nr_irqs)
 143 {
 144         struct irq_data *d = irq_domain_get_irq_data(domain, virq);
 145         struct pch_msi_data *priv = irq_data_get_irq_chip_data(d);
 146
 147         irq_domain_free_irqs_parent(domain, virq, nr_irqs);
 148         pch_msi_free_hwirq(priv, d->hwirq, nr_irqs);
 149 }
 150
 151 static const struct irq_domain_ops pch_msi_middle_domain_ops = {
 152         .alloc  = pch_msi_middle_domain_alloc,
 153         .free   = pch_msi_middle_domain_free,
 154 };
 155
 156 static int pch_msi_init_domains(struct pch_msi_data *priv,
 157                                 struct device_node *node,
 158                                 struct irq_domain *parent)
 159 {
 160         struct irq_domain *middle_domain, *msi_domain;
 161
 162         middle_domain = irq_domain_create_linear(of_node_to_fwnode(node),
 163                                                 priv->num_irqs,
 164                                                 &pch_msi_middle_domain_ops,
 165                                                 priv);
 166         if (!middle_domain) {
 167                 pr_err("Failed to create the MSI middle domain\n");
 168                 return -ENOMEM;
 169         }
 170
 171         middle_domain->parent = parent;
 172         irq_domain_update_bus_token(middle_domain, DOMAIN_BUS_NEXUS);
 173
 174         msi_domain = pci_msi_create_irq_domain(of_node_to_fwnode(node),
 175                                                &pch_msi_domain_info,
 176                                                middle_domain);
 177         if (!msi_domain) {
 178                 pr_err("Failed to create PCI MSI domain\n");
 179                 irq_domain_remove(middle_domain);
 180                 return -ENOMEM;
 181         }
 182
 183         return 0;
 184 }
 185
 186 static int pch_msi_init(struct device_node *node,
 187                             struct device_node *parent)
 188 {
 189         struct pch_msi_data *priv;
 190         struct irq_domain *parent_domain;
 191         struct resource res;
 192         int ret;
 193
 194         parent_domain = irq_find_host(parent);
 195         if (!parent_domain) {
 196                 pr_err("Failed to find the parent domain\n");
 197                 return -ENXIO;
 198         }
 199
 200         priv = kzalloc(sizeof(*priv), GFP_KERNEL);
 201         if (!priv)
 202                 return -ENOMEM;
 203
 204         mutex_init(&priv->msi_map_lock);
 205
 206         ret = of_address_to_resource(node, 0, &res);
 207         if (ret) {
 208                 pr_err("Failed to allocate resource\n");
 209                 goto err_priv;
 210         }
 211
 212         priv->doorbell = res.start;
 213
 214         if (of_property_read_u32(node, "loongson,msi-base-vec",
 215                                 &priv->irq_first)) {
 216                 pr_err("Unable to parse MSI vec base\n");
 217                 ret = -EINVAL;
 218                 goto err_priv;
 219         }
 220
 221         if (of_property_read_u32(node, "loongson,msi-num-vecs",
 222                                 &priv->num_irqs)) {
 223                 pr_err("Unable to parse MSI vec number\n");
 224                 ret = -EINVAL;
 225                 goto err_priv;
 226         }
 227
 228         priv->msi_map = bitmap_zalloc(priv->num_irqs, GFP_KERNEL);
 229         if (!priv->msi_map) {
 230                 ret = -ENOMEM;
 231                 goto err_priv;
 232         }
 233
 234         pr_debug("Registering %d MSIs, starting at %d\n",
 235                  priv->num_irqs, priv->irq_first);
 236
 237         ret = pch_msi_init_domains(priv, node, parent_domain);
 238         if (ret)
 239                 goto err_map;
 240
 241         return 0;
 242
 243 err_map:
 244         kfree(priv->msi_map);
 245 err_priv:
 246         kfree(priv);
 247         return ret;
 248 }
 249
 250 IRQCHIP_DECLARE(pch_msi, "loongson,pch-msi-1.0", pch_msi_init);