From: Neil Leeder <nlee...@codeaurora.org>

Add support for the SMMU Performance Monitor Counter Group
information from ACPI. This is in preparation for its use
in the SMMU v3 PMU driver.

Signed-off-by: Neil Leeder <nlee...@codeaurora.org>
Signed-off-by: Hanjun Guo <guohan...@huawei.com>
Signed-off-by: Shameer Kolothum <shameerali.kolothum.th...@huawei.com>
---
 drivers/acpi/arm64/iort.c | 95 +++++++++++++++++++++++++++++++++++++++++------
 1 file changed, 83 insertions(+), 12 deletions(-)

diff --git a/drivers/acpi/arm64/iort.c b/drivers/acpi/arm64/iort.c
index 7a3a541..ac4d0d6 100644
--- a/drivers/acpi/arm64/iort.c
+++ b/drivers/acpi/arm64/iort.c
@@ -356,7 +356,8 @@ static struct acpi_iort_node *iort_node_get_id(struct 
acpi_iort_node *node,
        if (map->flags & ACPI_IORT_ID_SINGLE_MAPPING) {
                if (node->type == ACPI_IORT_NODE_NAMED_COMPONENT ||
                    node->type == ACPI_IORT_NODE_PCI_ROOT_COMPLEX ||
-                   node->type == ACPI_IORT_NODE_SMMU_V3) {
+                   node->type == ACPI_IORT_NODE_SMMU_V3 ||
+                   node->type == ACPI_IORT_NODE_PMCG) {
                        *id_out = map->output_base;
                        return parent;
                }
@@ -394,6 +395,8 @@ static int iort_get_id_mapping_index(struct acpi_iort_node 
*node)
                }
 
                return smmu->id_mapping_index;
+       case ACPI_IORT_NODE_PMCG:
+               return 0;
        default:
                return -EINVAL;
        }
@@ -1287,6 +1290,63 @@ static bool __init arm_smmu_is_coherent(struct 
acpi_iort_node *node)
        return smmu->flags & ACPI_IORT_SMMU_COHERENT_WALK;
 }
 
+static void __init arm_smmu_common_dma_configure(struct device *dev,
+                                               enum dev_dma_attr attr)
+{
+       /* We expect the dma masks to be equivalent for all SMMUs set-ups */
+       dev->dma_mask = &dev->coherent_dma_mask;
+
+       /* Configure DMA for the page table walker */
+       acpi_dma_configure(dev, attr);
+}
+
+static int __init arm_smmu_v3_pmu_count_resources(struct acpi_iort_node *node)
+{
+       struct acpi_iort_pmcg *pmcg;
+
+       /* Retrieve PMCG specific data */
+       pmcg = (struct acpi_iort_pmcg *)node->node_data;
+
+       /*
+        * There are always 2 memory resources.
+        * If the overflow_gsiv is present then add that for a total of 3.
+        */
+       return pmcg->overflow_gsiv > 0 ? 3 : 2;
+}
+
+static void __init arm_smmu_v3_pmu_init_resources(struct resource *res,
+                                              struct acpi_iort_node *node)
+{
+       struct acpi_iort_pmcg *pmcg;
+
+       /* Retrieve PMCG specific data */
+       pmcg = (struct acpi_iort_pmcg *)node->node_data;
+
+       res[0].start = pmcg->page0_base_address;
+       res[0].end = pmcg->page0_base_address + SZ_4K - 1;
+       res[0].flags = IORESOURCE_MEM;
+       res[1].start = pmcg->page1_base_address;
+       res[1].end = pmcg->page1_base_address + SZ_4K - 1;
+       res[1].flags = IORESOURCE_MEM;
+
+       if (pmcg->overflow_gsiv)
+               acpi_iort_register_irq(pmcg->overflow_gsiv, "overflow",
+                                      ACPI_EDGE_SENSITIVE, &res[2]);
+}
+
+static struct acpi_iort_node *iort_find_pmcg_ref(struct acpi_iort_node *node)
+{
+       struct acpi_iort_pmcg *pmcg;
+       struct acpi_iort_node *ref_node = NULL;
+
+       /* Retrieve PMCG specific data */
+       pmcg = (struct acpi_iort_pmcg *)node->node_data;
+       if (pmcg->node_reference)
+               ref_node = ACPI_ADD_PTR(struct acpi_iort_node,
+                                       iort_table,  pmcg->node_reference);
+       return ref_node;
+}
+
 struct iort_dev_config {
        const char *name;
        int (*dev_init)(struct acpi_iort_node *node);
@@ -1296,6 +1356,8 @@ struct iort_dev_config {
                                     struct acpi_iort_node *node);
        void (*dev_set_proximity)(struct device *dev,
                                    struct acpi_iort_node *node);
+       void (*dev_dma_configure)(struct device *dev,
+                                       enum dev_dma_attr attr);
 };
 
 static const struct iort_dev_config iort_arm_smmu_v3_cfg __initconst = {
@@ -1304,23 +1366,38 @@ static const struct iort_dev_config 
iort_arm_smmu_v3_cfg __initconst = {
        .dev_count_resources = arm_smmu_v3_count_resources,
        .dev_init_resources = arm_smmu_v3_init_resources,
        .dev_set_proximity = arm_smmu_v3_set_proximity,
+       .dev_dma_configure = arm_smmu_common_dma_configure
 };
 
 static const struct iort_dev_config iort_arm_smmu_cfg __initconst = {
        .name = "arm-smmu",
        .dev_is_coherent = arm_smmu_is_coherent,
        .dev_count_resources = arm_smmu_count_resources,
-       .dev_init_resources = arm_smmu_init_resources
+       .dev_init_resources = arm_smmu_init_resources,
+       .dev_dma_configure = arm_smmu_common_dma_configure
+};
+
+static const struct iort_dev_config iort_arm_smmu_v3_pmcg_cfg __initconst = {
+       .name = "arm-smmu-v3-pmu",
+       .dev_count_resources = arm_smmu_v3_pmu_count_resources,
+       .dev_init_resources = arm_smmu_v3_pmu_init_resources
 };
 
 static __init const struct iort_dev_config *iort_get_dev_cfg(
                        struct acpi_iort_node *node)
 {
+       struct acpi_iort_node *ref_node;
+
        switch (node->type) {
        case ACPI_IORT_NODE_SMMU_V3:
                return &iort_arm_smmu_v3_cfg;
        case ACPI_IORT_NODE_SMMU:
                return &iort_arm_smmu_cfg;
+       case ACPI_IORT_NODE_PMCG:
+               /* Check this is associated with SMMUv3 */
+               ref_node = iort_find_pmcg_ref(node);
+               if (ref_node && ref_node->type == ACPI_IORT_NODE_SMMU_V3)
+                       return &iort_arm_smmu_v3_pmcg_cfg;
        default:
                return NULL;
        }
@@ -1376,12 +1453,6 @@ static int __init iort_add_platform_device(struct 
acpi_iort_node *node,
        if (ret)
                goto dev_put;
 
-       /*
-        * We expect the dma masks to be equivalent for
-        * all SMMUs set-ups
-        */
-       pdev->dev.dma_mask = &pdev->dev.coherent_dma_mask;
-
        fwnode = iort_get_fwnode(node);
 
        if (!fwnode) {
@@ -1391,11 +1462,11 @@ static int __init iort_add_platform_device(struct 
acpi_iort_node *node,
 
        pdev->dev.fwnode = fwnode;
 
-       attr = ops->dev_is_coherent && ops->dev_is_coherent(node) ?
+       if (ops->dev_dma_configure) {
+               attr = ops->dev_is_coherent && ops->dev_is_coherent(node) ?
                        DEV_DMA_COHERENT : DEV_DMA_NON_COHERENT;
-
-       /* Configure DMA for the page table walker */
-       acpi_dma_configure(&pdev->dev, attr);
+               ops->dev_dma_configure(&pdev->dev, attr);
+       }
 
        iort_set_device_domain(&pdev->dev, node);
 
-- 
2.7.4


Reply via email to