smmu学习笔记之arm_smmu_init_one_queue

在arm_smmu_init_queues 函数中会调用arm_smmu_init_one_queue 来初始化queue。
static int arm_smmu_init_queues(struct arm_smmu_device *smmu)
{
    int ret;

    /* cmdq */
    spin_lock_init(&smmu->cmdq.lock);
    ret = arm_smmu_init_one_queue(smmu, &smmu->cmdq.q, ARM_SMMU_CMDQ_PROD,
                      ARM_SMMU_CMDQ_CONS, CMDQ_ENT_DWORDS);
    if (ret)
        return ret;

    /* evtq */
    ret = arm_smmu_init_one_queue(smmu, &smmu->evtq.q, ARM_SMMU_EVTQ_PROD,
                      ARM_SMMU_EVTQ_CONS, EVTQ_ENT_DWORDS);
    if (ret)
        return ret;

    /* priq */
    if (!(smmu->features & ARM_SMMU_FEAT_PRI))
        return 0;

    return arm_smmu_init_one_queue(smmu, &smmu->priq.q, ARM_SMMU_PRIQ_PROD,
                       ARM_SMMU_PRIQ_CONS, PRIQ_ENT_DWORDS);
}
从arm_smmu_init_queues 中可以看到queue主要分为三种，即cmdq/evtq/priq
这三个函数都调用arm_smmu_init_one_queue来初始化，支持参数不一样，我们以cmdq为例
/* Probing and initialisation functions */
static int arm_smmu_init_one_queue(struct arm_smmu_device *smmu,
                   struct arm_smmu_queue *q,
                   unsigned long prod_off,
                   unsigned long cons_off,
                   size_t dwords)
{
    size_t qsz = ((1 << q->max_n_shift) * dwords) << 3;

    q->base = dmam_alloc_coherent(smmu->dev, qsz, &q->base_dma, GFP_KERNEL);
    if (!q->base) {
        dev_err(smmu->dev, "failed to allocate queue (0x%zx bytes)\n",
            qsz);
        return -ENOMEM;
    }

    q->prod_reg    = smmu->base + prod_off;
    q->cons_reg    = smmu->base + cons_off;
    q->ent_dwords    = dwords;

    q->q_base  = Q_BASE_RWA;
    q->q_base |= q->base_dma & Q_BASE_ADDR_MASK << Q_BASE_ADDR_SHIFT;
    q->q_base |= (q->max_n_shift & Q_BASE_LOG2SIZE_MASK)
             << Q_BASE_LOG2SIZE_SHIFT;

    q->prod = q->cons = 0;
    return 0;
}
首先这里的q是指smmu->cmdq.q，首先通过dmam_alloc_coherent 来申请size 的buffer.
然后就给products 和 consumer 来赋值，让其指向对应的硬件寄存器.可以看到这里都是通过smmu->base 加上偏移来赋值的。
smmu->base 是在arm_smmu_device_probe 函数中赋值的，可见这部分是通过bios传递过来的。
而    smmu->base = devm_ioremap_resource(dev, res);

而这里的cmdq的offset 定义如下：
#define ARM_SMMU_CMDQ_PROD        0x98
#define ARM_SMMU_CMDQ_CONS        0x9c
最后是给q_base 赋值和将products 和 consumer的位置清零来初始化q->prod = q->cons = 0;
这里给q_base/q.prod/q.cons。最终都会在arm_smmu_device_reset 中写到smmu的寄存器中去.
    /* Command queue */
    writeq_relaxed(smmu->cmdq.q.q_base, smmu->base + ARM_SMMU_CMDQ_BASE);
    writel_relaxed(smmu->cmdq.q.prod, smmu->base + ARM_SMMU_CMDQ_PROD);
    writel_relaxed(smmu->cmdq.q.cons, smmu->base + ARM_SMMU_CMDQ_CONS);