genirq: Provide default callbacks for msi_domain_ops

Extend struct msi_domain_info and provide default callbacks for
msi_domain_ops.

Signed-off-by: Jiang Liu <jiang.liu@linux.intel.com>
Cc: Tony Luck <tony.luck@intel.com>
Cc: linux-arm-kernel@lists.infradead.org
Cc: Bjorn Helgaas <bhelgaas@google.com>
Cc: Grant Likely <grant.likely@linaro.org>
Cc: Marc Zyngier <marc.zyngier@arm.com>
Cc: Yijing Wang <wangyijing@huawei.com>
Cc: Yingjoe Chen <yingjoe.chen@mediatek.com>
Cc: Borislav Petkov <bp@alien8.de>
Cc: Matthias Brugger <matthias.bgg@gmail.com>
Cc: Alexander Gordeev <agordeev@redhat.com>
Link: http://lkml.kernel.org/r/1416061447-9472-8-git-send-email-jiang.liu@linux.intel.com
Signed-off-by: Thomas Gleixner <tglx@linutronix.de>

2 files changed, 140 insertions, 13 deletions

diff --git a/include/linux/msi.h b/include/linux/msi.h
index 7a93a988dce8..0098e2c8fd42 100644
--- a/include/linux/msi.h
+++ b/include/linux/msi.h
@@ -116,6 +116,7 @@ struct msi_controller {
 
 #ifdef CONFIG_GENERIC_MSI_IRQ_DOMAIN
 
+#include <linux/irqhandler.h>
 #include <asm/msi.h>
 
 struct irq_domain;
@@ -142,11 +143,12 @@ struct msi_domain_info;
  * interfaces which are based on msi_desc.
  */
 struct msi_domain_ops {
-        irq_hw_number_t (*get_hwirq)(struct msi_domain_info *info, void *arg);
+        irq_hw_number_t (*get_hwirq)(struct msi_domain_info *info,
+                                     msi_alloc_info_t *arg);
         int             (*msi_init)(struct irq_domain *domain,
                                     struct msi_domain_info *info,
                                     unsigned int virq, irq_hw_number_t hwirq,
-                                    void *arg);
+                                    msi_alloc_info_t *arg);
         void            (*msi_free)(struct irq_domain *domain,
                                     struct msi_domain_info *info,
                                     unsigned int virq);
@@ -165,16 +167,46 @@ struct msi_domain_ops {
 
 /**
  * struct msi_domain_info - MSI interrupt domain data
- * @ops:        The callback data structure
- * @chip:       The associated interrupt chip
- * @data:       Domain specific data
+ * @flags:              Flags to decribe features and capabilities
+ * @ops:                The callback data structure
+ * @chip:               Optional: associated interrupt chip
+ * @chip_data:          Optional: associated interrupt chip data
+ * @handler:            Optional: associated interrupt flow handler
+ * @handler_data:       Optional: associated interrupt flow handler data
+ * @handler_name:       Optional: associated interrupt flow handler name
+ * @data:               Optional: domain specific data
  */
 struct msi_domain_info {
+        u32                     flags;
         struct msi_domain_ops   *ops;
         struct irq_chip         *chip;
+        void                    *chip_data;
+        irq_flow_handler_t      handler;
+        void                    *handler_data;
+        const char              *handler_name;
         void                    *data;
 };
 
+/* Flags for msi_domain_info */
+enum {
+        /*
+         * Init non implemented ops callbacks with default MSI domain
+         * callbacks.
+         */
+        MSI_FLAG_USE_DEF_DOM_OPS        = (1 << 0),
+        /*
+         * Init non implemented chip callbacks with default MSI chip
+         * callbacks.
+         */
+        MSI_FLAG_USE_DEF_CHIP_OPS       = (1 << 1),
+        /* Build identity map between hwirq and irq */
+        MSI_FLAG_IDENTITY_MAP           = (1 << 2),
+        /* Support multiple PCI MSI interrupts */
+        MSI_FLAG_MULTI_PCI_MSI          = (1 << 3),
+        /* Support PCI MSIX interrupts */
+        MSI_FLAG_PCI_MSIX               = (1 << 4),
+};
+
 int msi_domain_set_affinity(struct irq_data *data, const struct cpumask *mask,
                             bool force);
 
diff --git a/kernel/irq/msi.c b/kernel/irq/msi.c
index 23111aaa06b2..d0fe84d881f6 100644
--- a/kernel/irq/msi.c
+++ b/kernel/irq/msi.c
@@ -9,6 +9,8 @@
  * This file contains common code to support Message Signalled Interrupt for
  * PCI compatible and non PCI compatible devices.
  */
+#include <linux/types.h>
+#include <linux/device.h>
 #include <linux/irq.h>
 #include <linux/irqdomain.h>
 #include <linux/msi.h>
@@ -110,23 +112,112 @@ static struct irq_domain_ops msi_domain_ops = {
         .deactivate     = msi_domain_deactivate,
 };
 
+#ifdef GENERIC_MSI_DOMAIN_OPS
+static irq_hw_number_t msi_domain_ops_get_hwirq(struct msi_domain_info *info,
+                                                msi_alloc_info_t *arg)
+{
+        return arg->hwirq;
+}
+
+static int msi_domain_ops_prepare(struct irq_domain *domain, struct device *dev,
+                                  int nvec, msi_alloc_info_t *arg)
+{
+        memset(arg, 0, sizeof(*arg));
+        return 0;
+}
+
+static void msi_domain_ops_set_desc(msi_alloc_info_t *arg,
+                                    struct msi_desc *desc)
+{
+        arg->desc = desc;
+}
+#else
+#define msi_domain_ops_get_hwirq        NULL
+#define msi_domain_ops_prepare          NULL
+#define msi_domain_ops_set_desc         NULL
+#endif /* !GENERIC_MSI_DOMAIN_OPS */
+
+static int msi_domain_ops_init(struct irq_domain *domain,
+                               struct msi_domain_info *info,
+                               unsigned int virq, irq_hw_number_t hwirq,
+                               msi_alloc_info_t *arg)
+{
+        irq_domain_set_hwirq_and_chip(domain, virq, hwirq, info->chip,
+                                      info->chip_data);
+        if (info->handler && info->handler_name) {
+                __irq_set_handler(virq, info->handler, 0, info->handler_name);
+                if (info->handler_data)
+                        irq_set_handler_data(virq, info->handler_data);
+        }
+        return 0;
+}
+
+static int msi_domain_ops_check(struct irq_domain *domain,
+                                struct msi_domain_info *info,
+                                struct device *dev)
+{
+        return 0;
+}
+
+static struct msi_domain_ops msi_domain_ops_default = {
+        .get_hwirq      = msi_domain_ops_get_hwirq,
+        .msi_init       = msi_domain_ops_init,
+        .msi_check      = msi_domain_ops_check,
+        .msi_prepare    = msi_domain_ops_prepare,
+        .set_desc       = msi_domain_ops_set_desc,
+};
+
+static void msi_domain_update_dom_ops(struct msi_domain_info *info)
+{
+        struct msi_domain_ops *ops = info->ops;
+
+        if (ops == NULL) {
+                info->ops = &msi_domain_ops_default;
+                return;
+        }
+
+        if (ops->get_hwirq == NULL)
+                ops->get_hwirq = msi_domain_ops_default.get_hwirq;
+        if (ops->msi_init == NULL)
+                ops->msi_init = msi_domain_ops_default.msi_init;
+        if (ops->msi_check == NULL)
+                ops->msi_check = msi_domain_ops_default.msi_check;
+        if (ops->msi_prepare == NULL)
+                ops->msi_prepare = msi_domain_ops_default.msi_prepare;
+        if (ops->set_desc == NULL)
+                ops->set_desc = msi_domain_ops_default.set_desc;
+}
+
+static void msi_domain_update_chip_ops(struct msi_domain_info *info)
+{
+        struct irq_chip *chip = info->chip;
+
+        BUG_ON(!chip);
+        if (!chip->irq_mask)
+                chip->irq_mask = pci_msi_mask_irq;
+        if (!chip->irq_unmask)
+                chip->irq_unmask = pci_msi_unmask_irq;
+        if (!chip->irq_set_affinity)
+                chip->irq_set_affinity = msi_domain_set_affinity;
+}
+
 /**
  * msi_create_irq_domain - Create a MSI interrupt domain
  * @of_node:    Optional device-tree node of the interrupt controller
  * @info:       MSI domain info
  * @parent:     Parent irq domain
  */
-struct irq_domain *msi_create_irq_domain(struct device_node *of_node,
+struct irq_domain *msi_create_irq_domain(struct device_node *node,
                                          struct msi_domain_info *info,
                                          struct irq_domain *parent)
 {
-        struct irq_domain *domain;
+        if (info->flags & MSI_FLAG_USE_DEF_DOM_OPS)
+                msi_domain_update_dom_ops(info);
+        if (info->flags & MSI_FLAG_USE_DEF_CHIP_OPS)
+                msi_domain_update_chip_ops(info);
 
-        domain = irq_domain_add_tree(of_node, &msi_domain_ops, info);
-        if (domain)
-                domain->parent = parent;
-
-        return domain;
+        return irq_domain_add_hierarchy(parent, 0, 0, node, &msi_domain_ops,
+                                        info);
 }
 
 /**
@@ -155,8 +246,12 @@ int msi_domain_alloc_irqs(struct irq_domain *domain, struct device *dev,
 
         for_each_msi_entry(desc, dev) {
                 ops->set_desc(&arg, desc);
+                if (info->flags & MSI_FLAG_IDENTITY_MAP)
+                        virq = (int)ops->get_hwirq(info, &arg);
+                else
+                        virq = -1;
 
-                virq = __irq_domain_alloc_irqs(domain, -1, desc->nvec_used,
+                virq = __irq_domain_alloc_irqs(domain, virq, desc->nvec_used,
                                                dev_to_node(dev), &arg, false);
                 if (virq < 0) {
                         ret = -ENOSPC;