smmu_v3_cmdexec.cc revision 14064
114039Sstacze01@arm.com/*
214039Sstacze01@arm.com * Copyright (c) 2013, 2018-2019 ARM Limited
314039Sstacze01@arm.com * All rights reserved
414039Sstacze01@arm.com *
514039Sstacze01@arm.com * The license below extends only to copyright in the software and shall
614039Sstacze01@arm.com * not be construed as granting a license to any other intellectual
714039Sstacze01@arm.com * property including but not limited to intellectual property relating
814039Sstacze01@arm.com * to a hardware implementation of the functionality of the software
914039Sstacze01@arm.com * licensed hereunder.  You may use the software subject to the license
1014039Sstacze01@arm.com * terms below provided that you ensure that this notice is replicated
1114039Sstacze01@arm.com * unmodified and in its entirety in all distributions of the software,
1214039Sstacze01@arm.com * modified or unmodified, in source code or in binary form.
1314039Sstacze01@arm.com *
1414039Sstacze01@arm.com * Redistribution and use in source and binary forms, with or without
1514039Sstacze01@arm.com * modification, are permitted provided that the following conditions are
1614039Sstacze01@arm.com * met: redistributions of source code must retain the above copyright
1714039Sstacze01@arm.com * notice, this list of conditions and the following disclaimer;
1814039Sstacze01@arm.com * redistributions in binary form must reproduce the above copyright
1914039Sstacze01@arm.com * notice, this list of conditions and the following disclaimer in the
2014039Sstacze01@arm.com * documentation and/or other materials provided with the distribution;
2114039Sstacze01@arm.com * neither the name of the copyright holders nor the names of its
2214039Sstacze01@arm.com * contributors may be used to endorse or promote products derived from
2314039Sstacze01@arm.com * this software without specific prior written permission.
2414039Sstacze01@arm.com *
2514039Sstacze01@arm.com * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
2614039Sstacze01@arm.com * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
2714039Sstacze01@arm.com * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
2814039Sstacze01@arm.com * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
2914039Sstacze01@arm.com * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
3014039Sstacze01@arm.com * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
3114039Sstacze01@arm.com * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
3214039Sstacze01@arm.com * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
3314039Sstacze01@arm.com * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
3414039Sstacze01@arm.com * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
3514039Sstacze01@arm.com * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
3614039Sstacze01@arm.com *
3714039Sstacze01@arm.com * Authors: Stan Czerniawski
3814039Sstacze01@arm.com */
3914039Sstacze01@arm.com
4014039Sstacze01@arm.com#include "dev/arm/smmu_v3_cmdexec.hh"
4114039Sstacze01@arm.com
4214039Sstacze01@arm.com#include "base/bitfield.hh"
4314039Sstacze01@arm.com#include "dev/arm/smmu_v3.hh"
4414039Sstacze01@arm.com
4514039Sstacze01@arm.comvoid
4614039Sstacze01@arm.comSMMUCommandExecProcess::main(Yield &yield)
4714039Sstacze01@arm.com{
4814039Sstacze01@arm.com    SMMUAction a;
4914039Sstacze01@arm.com    a.type = ACTION_INITIAL_NOP;
5014039Sstacze01@arm.com    a.pkt = NULL;
5114039Sstacze01@arm.com    a.ifc = nullptr;
5214039Sstacze01@arm.com    a.delay = 0;
5314039Sstacze01@arm.com    yield(a);
5414039Sstacze01@arm.com
5514039Sstacze01@arm.com    while (true) {
5614039Sstacze01@arm.com        busy = true;
5714039Sstacze01@arm.com
5814039Sstacze01@arm.com        while (true) {
5914039Sstacze01@arm.com            int sizeMask =
6014039Sstacze01@arm.com                mask(smmu.regs.cmdq_base & Q_BASE_SIZE_MASK) & Q_CONS_PROD_MASK;
6114039Sstacze01@arm.com
6214039Sstacze01@arm.com            if ((smmu.regs.cmdq_cons & sizeMask) ==
6314039Sstacze01@arm.com                    (smmu.regs.cmdq_prod & sizeMask))
6414039Sstacze01@arm.com                break; // command queue empty
6514039Sstacze01@arm.com
6614039Sstacze01@arm.com            Addr cmdAddr =
6714039Sstacze01@arm.com                (smmu.regs.cmdq_base & Q_BASE_ADDR_MASK) +
6814039Sstacze01@arm.com                (smmu.regs.cmdq_cons & sizeMask) * sizeof(SMMUCommand);
6914039Sstacze01@arm.com
7014039Sstacze01@arm.com            // This deliberately resets the error field in cmdq_cons!
7114039Sstacze01@arm.com            smmu.regs.cmdq_cons = (smmu.regs.cmdq_cons + 1) & sizeMask;
7214039Sstacze01@arm.com
7314039Sstacze01@arm.com            doRead(yield, cmdAddr, &cmd, sizeof(SMMUCommand));
7414039Sstacze01@arm.com            smmu.processCommand(cmd);
7514039Sstacze01@arm.com        }
7614039Sstacze01@arm.com
7714039Sstacze01@arm.com        busy = false;
7814064Sadrian.herrera@arm.com        // No more commands to process, signal the SMMU as drained
7914064Sadrian.herrera@arm.com        smmu.signalDrainDone();
8014039Sstacze01@arm.com
8114039Sstacze01@arm.com        doSleep(yield);
8214039Sstacze01@arm.com    }
8314039Sstacze01@arm.com}
84