Commit d3097e39 authored by Robin Murphy's avatar Robin Murphy Committed by Will Deacon

iommu/arm-smmu: Add a stream map entry iterator

We iterate over the SMEs associated with a master config quite a lot in
various places, and are about to do so even more. Let's wrap the idiom
in a handy iterator macro before the repetition gets out of hand.
Tested-by: default avatarLorenzo Pieralisi <lorenzo.pieralisi@arm.com>
Signed-off-by: default avatarRobin Murphy <robin.murphy@arm.com>
Signed-off-by: default avatarWill Deacon <will.deacon@arm.com>
parent d6fc5d97
...@@ -324,6 +324,8 @@ struct arm_smmu_master_cfg { ...@@ -324,6 +324,8 @@ struct arm_smmu_master_cfg {
s16 smendx[MAX_MASTER_STREAMIDS]; s16 smendx[MAX_MASTER_STREAMIDS];
}; };
#define INVALID_SMENDX -1 #define INVALID_SMENDX -1
#define for_each_cfg_sme(cfg, i, idx) \
for (i = 0; idx = cfg->smendx[i], i < cfg->num_streamids; ++i)
struct arm_smmu_device { struct arm_smmu_device {
struct device *dev; struct device *dev;
...@@ -1090,8 +1092,8 @@ static int arm_smmu_master_alloc_smes(struct arm_smmu_device *smmu, ...@@ -1090,8 +1092,8 @@ static int arm_smmu_master_alloc_smes(struct arm_smmu_device *smmu,
int i, idx; int i, idx;
/* Allocate the SMRs on the SMMU */ /* Allocate the SMRs on the SMMU */
for (i = 0; i < cfg->num_streamids; ++i) { for_each_cfg_sme(cfg, i, idx) {
if (cfg->smendx[i] != INVALID_SMENDX) if (idx != INVALID_SMENDX)
return -EEXIST; return -EEXIST;
/* ...except on stream indexing hardware, of course */ /* ...except on stream indexing hardware, of course */
...@@ -1115,8 +1117,8 @@ static int arm_smmu_master_alloc_smes(struct arm_smmu_device *smmu, ...@@ -1115,8 +1117,8 @@ static int arm_smmu_master_alloc_smes(struct arm_smmu_device *smmu,
return 0; return 0;
/* It worked! Now, poke the actual hardware */ /* It worked! Now, poke the actual hardware */
for (i = 0; i < cfg->num_streamids; ++i) for_each_cfg_sme(cfg, i, idx)
arm_smmu_write_smr(smmu, cfg->smendx[i]); arm_smmu_write_smr(smmu, idx);
return 0; return 0;
...@@ -1131,15 +1133,13 @@ static int arm_smmu_master_alloc_smes(struct arm_smmu_device *smmu, ...@@ -1131,15 +1133,13 @@ static int arm_smmu_master_alloc_smes(struct arm_smmu_device *smmu,
static void arm_smmu_master_free_smes(struct arm_smmu_master_cfg *cfg) static void arm_smmu_master_free_smes(struct arm_smmu_master_cfg *cfg)
{ {
struct arm_smmu_device *smmu = cfg->smmu; struct arm_smmu_device *smmu = cfg->smmu;
int i; int i, idx;
/* /*
* We *must* clear the S2CR first, because freeing the SMR means * We *must* clear the S2CR first, because freeing the SMR means
* that it can be re-allocated immediately. * that it can be re-allocated immediately.
*/ */
for (i = 0; i < cfg->num_streamids; ++i) { for_each_cfg_sme(cfg, i, idx) {
int idx = cfg->smendx[i];
/* An IOMMU group is torn down by the first device to be removed */ /* An IOMMU group is torn down by the first device to be removed */
if (idx == INVALID_SMENDX) if (idx == INVALID_SMENDX)
return; return;
...@@ -1151,9 +1151,9 @@ static void arm_smmu_master_free_smes(struct arm_smmu_master_cfg *cfg) ...@@ -1151,9 +1151,9 @@ static void arm_smmu_master_free_smes(struct arm_smmu_master_cfg *cfg)
__iowmb(); __iowmb();
/* Invalidate the SMRs before freeing back to the allocator */ /* Invalidate the SMRs before freeing back to the allocator */
for (i = 0; i < cfg->num_streamids; ++i) { for_each_cfg_sme(cfg, i, idx) {
if (smmu->smrs) if (smmu->smrs)
arm_smmu_free_smr(smmu, cfg->smendx[i]); arm_smmu_free_smr(smmu, idx);
cfg->smendx[i] = INVALID_SMENDX; cfg->smendx[i] = INVALID_SMENDX;
} }
...@@ -1162,7 +1162,7 @@ static void arm_smmu_master_free_smes(struct arm_smmu_master_cfg *cfg) ...@@ -1162,7 +1162,7 @@ static void arm_smmu_master_free_smes(struct arm_smmu_master_cfg *cfg)
static int arm_smmu_domain_add_master(struct arm_smmu_domain *smmu_domain, static int arm_smmu_domain_add_master(struct arm_smmu_domain *smmu_domain,
struct arm_smmu_master_cfg *cfg) struct arm_smmu_master_cfg *cfg)
{ {
int i, ret = 0; int i, idx, ret = 0;
struct arm_smmu_device *smmu = smmu_domain->smmu; struct arm_smmu_device *smmu = smmu_domain->smmu;
struct arm_smmu_s2cr *s2cr = smmu->s2crs; struct arm_smmu_s2cr *s2cr = smmu->s2crs;
enum arm_smmu_s2cr_type type = S2CR_TYPE_TRANS; enum arm_smmu_s2cr_type type = S2CR_TYPE_TRANS;
...@@ -1182,9 +1182,7 @@ static int arm_smmu_domain_add_master(struct arm_smmu_domain *smmu_domain, ...@@ -1182,9 +1182,7 @@ static int arm_smmu_domain_add_master(struct arm_smmu_domain *smmu_domain,
if (smmu_domain->domain.type == IOMMU_DOMAIN_DMA) if (smmu_domain->domain.type == IOMMU_DOMAIN_DMA)
type = S2CR_TYPE_BYPASS; type = S2CR_TYPE_BYPASS;
for (i = 0; i < cfg->num_streamids; ++i) { for_each_cfg_sme(cfg, i, idx) {
int idx = cfg->smendx[i];
/* Devices in an IOMMU group may already be configured */ /* Devices in an IOMMU group may already be configured */
if (type == s2cr[idx].type && cbndx == s2cr[idx].cbndx) if (type == s2cr[idx].type && cbndx == s2cr[idx].cbndx)
break; break;
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment