From: Jason Gunthorpe <[email protected]>

The new function is used to take in a u64 MSI address and store it in the
msi_msg. If the iommu has provided an alternative address then that is
replaced instead.

All callers have a tidy u64 already so this also consolidates the repeated
low/high code into a small helper.

Signed-off-by: Jason Gunthorpe <[email protected]>
Signed-off-by: Nicolin Chen <[email protected]>
---
 include/linux/msi.h               | 18 ++++++++----------
 drivers/irqchip/irq-gic-v2m.c     |  5 +----
 drivers/irqchip/irq-gic-v3-its.c  | 13 +++----------
 drivers/irqchip/irq-gic-v3-mbi.c  | 12 ++++--------
 drivers/irqchip/irq-ls-scfg-msi.c |  5 ++---
 5 files changed, 18 insertions(+), 35 deletions(-)

diff --git a/include/linux/msi.h b/include/linux/msi.h
index d442b4a69d56..f6369748fc6e 100644
--- a/include/linux/msi.h
+++ b/include/linux/msi.h
@@ -296,13 +296,8 @@ static inline void msi_desc_set_iommu_msi_iova(struct 
msi_desc *desc,
 #endif
 }
 
-/**
- * iommu_dma_compose_msi_msg() - Apply translation to an MSI message
- * @desc: MSI descriptor prepared by iommu_dma_prepare_msi()
- * @msg: MSI message containing target physical address
- */
-static inline void iommu_dma_compose_msi_msg(struct msi_desc *desc,
-                                            struct msi_msg *msg)
+static inline void msi_msg_set_msi_addr(struct msi_desc *desc,
+                                       struct msi_msg *msg, u64 msi_addr)
 {
 #ifdef CONFIG_IRQ_MSI_IOMMU
        if (desc->iommu_msi_page_shift) {
@@ -310,11 +305,14 @@ static inline void iommu_dma_compose_msi_msg(struct 
msi_desc *desc,
                               << desc->iommu_msi_page_shift;
 
                msg->address_hi = upper_32_bits(msi_iova);
-               msg->address_lo = lower_32_bits(msi_iova) |
-                                 (msg->address_lo &
-                                  ((1 << desc->iommu_msi_page_shift) - 1));
+               msg->address_lo =
+                       lower_32_bits(msi_iova) |
+                       (msi_addr & ((1 << desc->iommu_msi_page_shift) - 1));
+               return;
        }
 #endif
+       msg->address_hi = upper_32_bits(msi_addr);
+       msg->address_lo = lower_32_bits(msi_addr);
 }
 
 int msi_domain_insert_msi_desc(struct device *dev, unsigned int domid,
diff --git a/drivers/irqchip/irq-gic-v2m.c b/drivers/irqchip/irq-gic-v2m.c
index be35c5349986..6599c56873ad 100644
--- a/drivers/irqchip/irq-gic-v2m.c
+++ b/drivers/irqchip/irq-gic-v2m.c
@@ -87,9 +87,6 @@ static void gicv2m_compose_msi_msg(struct irq_data *data, 
struct msi_msg *msg)
        struct v2m_data *v2m = irq_data_get_irq_chip_data(data);
        phys_addr_t addr = gicv2m_get_msi_addr(v2m, data->hwirq);
 
-       msg->address_hi = upper_32_bits(addr);
-       msg->address_lo = lower_32_bits(addr);
-
        if (v2m->flags & GICV2M_GRAVITON_ADDRESS_ONLY)
                msg->data = 0;
        else
@@ -97,7 +94,7 @@ static void gicv2m_compose_msi_msg(struct irq_data *data, 
struct msi_msg *msg)
        if (v2m->flags & GICV2M_NEEDS_SPI_OFFSET)
                msg->data -= v2m->spi_offset;
 
-       iommu_dma_compose_msi_msg(irq_data_get_msi_desc(data), msg);
+       msi_msg_set_msi_addr(irq_data_get_msi_desc(data), msg, addr);
 }
 
 static struct irq_chip gicv2m_irq_chip = {
diff --git a/drivers/irqchip/irq-gic-v3-its.c b/drivers/irqchip/irq-gic-v3-its.c
index 92244cfa0464..8c3ab7b471ca 100644
--- a/drivers/irqchip/irq-gic-v3-its.c
+++ b/drivers/irqchip/irq-gic-v3-its.c
@@ -1809,17 +1809,10 @@ static u64 its_irq_get_msi_base(struct its_device 
*its_dev)
 static void its_irq_compose_msi_msg(struct irq_data *d, struct msi_msg *msg)
 {
        struct its_device *its_dev = irq_data_get_irq_chip_data(d);
-       struct its_node *its;
-       u64 addr;
-
-       its = its_dev->its;
-       addr = its->get_msi_base(its_dev);
-
-       msg->address_lo         = lower_32_bits(addr);
-       msg->address_hi         = upper_32_bits(addr);
-       msg->data               = its_get_event_id(d);
 
-       iommu_dma_compose_msi_msg(irq_data_get_msi_desc(d), msg);
+       msg->data = its_get_event_id(d);
+       msi_msg_set_msi_addr(irq_data_get_msi_desc(d), msg,
+                            its_dev->its->get_msi_base(its_dev));
 }
 
 static int its_irq_set_irqchip_state(struct irq_data *d,
diff --git a/drivers/irqchip/irq-gic-v3-mbi.c b/drivers/irqchip/irq-gic-v3-mbi.c
index 3fe870f8ee17..513479da9ee3 100644
--- a/drivers/irqchip/irq-gic-v3-mbi.c
+++ b/drivers/irqchip/irq-gic-v3-mbi.c
@@ -147,22 +147,18 @@ static const struct irq_domain_ops mbi_domain_ops = {
 
 static void mbi_compose_msi_msg(struct irq_data *data, struct msi_msg *msg)
 {
-       msg[0].address_hi = upper_32_bits(mbi_phys_base + GICD_SETSPI_NSR);
-       msg[0].address_lo = lower_32_bits(mbi_phys_base + GICD_SETSPI_NSR);
        msg[0].data = data->parent_data->hwirq;
-
-       iommu_dma_compose_msi_msg(irq_data_get_msi_desc(data), msg);
+       msi_msg_set_msi_addr(irq_data_get_msi_desc(data), &msg[0],
+                            mbi_phys_base + GICD_SETSPI_NSR);
 }
 
 static void mbi_compose_mbi_msg(struct irq_data *data, struct msi_msg *msg)
 {
        mbi_compose_msi_msg(data, msg);
 
-       msg[1].address_hi = upper_32_bits(mbi_phys_base + GICD_CLRSPI_NSR);
-       msg[1].address_lo = lower_32_bits(mbi_phys_base + GICD_CLRSPI_NSR);
        msg[1].data = data->parent_data->hwirq;
-
-       iommu_dma_compose_msi_msg(irq_data_get_msi_desc(data), &msg[1]);
+       msi_msg_set_msi_addr(irq_data_get_msi_desc(data), &msg[1],
+                            mbi_phys_base + GICD_CLRSPI_NSR);
 }
 
 static bool mbi_init_dev_msi_info(struct device *dev, struct irq_domain 
*domain,
diff --git a/drivers/irqchip/irq-ls-scfg-msi.c 
b/drivers/irqchip/irq-ls-scfg-msi.c
index c0e1aafe468c..2ac6d89b4cb4 100644
--- a/drivers/irqchip/irq-ls-scfg-msi.c
+++ b/drivers/irqchip/irq-ls-scfg-msi.c
@@ -87,8 +87,6 @@ static void ls_scfg_msi_compose_msg(struct irq_data *data, 
struct msi_msg *msg)
 {
        struct ls_scfg_msi *msi_data = irq_data_get_irq_chip_data(data);
 
-       msg->address_hi = upper_32_bits(msi_data->msiir_addr);
-       msg->address_lo = lower_32_bits(msi_data->msiir_addr);
        msg->data = data->hwirq;
 
        if (msi_affinity_flag) {
@@ -98,7 +96,8 @@ static void ls_scfg_msi_compose_msg(struct irq_data *data, 
struct msi_msg *msg)
                msg->data |= cpumask_first(mask);
        }
 
-       iommu_dma_compose_msi_msg(irq_data_get_msi_desc(data), msg);
+       msi_msg_set_msi_addr(irq_data_get_msi_desc(data), msg,
+                            msi_data->msiir_addr);
 }
 
 static int ls_scfg_msi_set_affinity(struct irq_data *irq_data,
-- 
2.43.0


Reply via email to