/*
 * Copyright 2023 Advanced Micro Devices, Inc.
 *
 * Permission is hereby granted, free of charge, to any person obtaining a
 * copy of this software and associated documentation files (the "Software"),
 * to deal in the Software without restriction, including without limitation
 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
 * and/or sell copies of the Software, and to permit persons to whom the
 * Software is furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included in
 * all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
 * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
 * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
 * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
 * OTHER DEALINGS IN THE SOFTWARE.
 *
 */

#include "amdgpu.h"
#include "mmhub_v3_3.h"

#include "mmhub/mmhub_3_3_0_offset.h"
#include "mmhub/mmhub_3_3_0_sh_mask.h"

#include "navi10_enum.h"
#include "soc15_common.h"

#define regMMVM_L2_CNTL3_DEFAULT                                0x80100007
#define regMMVM_L2_CNTL4_DEFAULT                                0x000000c1
#define regMMVM_L2_CNTL5_DEFAULT                                0x00003fe0
#define regDAGB0_L1TLB_REG_RW_3_3                   0x00a4
#define regDAGB0_L1TLB_REG_RW_3_3_BASE_IDX          1
#define regDAGB1_L1TLB_REG_RW_3_3                   0x0163
#define regDAGB1_L1TLB_REG_RW_3_3_BASE_IDX          1

static const char *mmhub_client_ids_v3_3[][2] = {
        [0][0] = "VMC",
        [1][0] = "ISPXT",
        [2][0] = "ISPIXT",
        [4][0] = "DCEDMC",
        [6][0] = "MP0",
        [7][0] = "MP1",
        [8][0] = "MPM",
        [9][0] = "ISPPDPRD",
        [10][0] = "ISPCSTATRD",
        [11][0] = "ISPBYRPRD",
        [12][0] = "ISPRGBPRD",
        [13][0] = "ISPMCFPRD",
        [14][0] = "ISPMCFPRD1",
        [15][0] = "ISPYUVPRD",
        [16][0] = "ISPMCSCRD",
        [17][0] = "ISPGDCRD",
        [18][0] = "ISPLMERD",
        [22][0] = "ISPXT1",
        [23][0] = "ISPIXT1",
        [24][0] = "HDP",
        [25][0] = "LSDMA",
        [26][0] = "JPEG",
        [27][0] = "VPE",
        [28][0] = "VSCH",
        [29][0] = "VCNU",
        [30][0] = "VCN",
        [1][1] = "ISPXT",
        [2][1] = "ISPIXT",
        [3][1] = "DCEDWB",
        [4][1] = "DCEDMC",
        [5][1] = "ISPCSISWR",
        [6][1] = "MP0",
        [7][1] = "MP1",
        [8][1] = "MPM",
        [9][1] = "ISPPDPWR",
        [10][1] = "ISPCSTATWR",
        [11][1] = "ISPBYRPWR",
        [12][1] = "ISPRGBPWR",
        [13][1] = "ISPMCFPWR",
        [14][1] = "ISPMWR0",
        [15][1] = "ISPYUVPWR",
        [16][1] = "ISPMCSCWR",
        [17][1] = "ISPGDCWR",
        [18][1] = "ISPLMEWR",
        [20][1] = "ISPMWR2",
        [21][1] = "OSSSYS",
        [22][1] = "ISPXT1",
        [23][1] = "ISPIXT1",
        [24][1] = "HDP",
        [25][1] = "LSDMA",
        [26][1] = "JPEG",
        [27][1] = "VPE",
        [28][1] = "VSCH",
        [29][1] = "VCNU",
        [30][1] = "VCN",
};

static const char *mmhub_client_ids_v3_3_1[][2] = {
        [0][0] = "VMC",
        [4][0] = "DCEDMC",
        [6][0] = "MP0",
        [7][0] = "MP1",
        [8][0] = "MPM",
        [24][0] = "HDP",
        [25][0] = "LSDMA",
        [26][0] = "JPEG0",
        [27][0] = "VPE0",
        [28][0] = "VSCH",
        [29][0] = "VCNU0",
        [30][0] = "VCN0",
        [32+1][0] = "ISPXT",
        [32+2][0] = "ISPIXT",
        [32+9][0] = "ISPPDPRD",
        [32+10][0] = "ISPCSTATRD",
        [32+11][0] = "ISPBYRPRD",
        [32+12][0] = "ISPRGBPRD",
        [32+13][0] = "ISPMCFPRD",
        [32+14][0] = "ISPMCFPRD1",
        [32+15][0] = "ISPYUVPRD",
        [32+16][0] = "ISPMCSCRD",
        [32+17][0] = "ISPGDCRD",
        [32+18][0] = "ISPLMERD",
        [32+22][0] = "ISPXT1",
        [32+23][0] = "ISPIXT1",
        [32+26][0] = "JPEG1",
        [32+27][0] = "VPE1",
        [32+29][0] = "VCNU1",
        [32+30][0] = "VCN1",
        [3][1] = "DCEDWB",
        [4][1] = "DCEDMC",
        [6][1] = "MP0",
        [7][1] = "MP1",
        [8][1] = "MPM",
        [21][1] = "OSSSYS",
        [24][1] = "HDP",
        [25][1] = "LSDMA",
        [26][1] = "JPEG0",
        [27][1] = "VPE0",
        [28][1] = "VSCH",
        [29][1] = "VCNU0",
        [30][1] = "VCN0",
        [32+1][1] = "ISPXT",
        [32+2][1] = "ISPIXT",
        [32+5][1] = "ISPCSISWR",
        [32+9][1] = "ISPPDPWR",
        [32+10][1] = "ISPCSTATWR",
        [32+11][1] = "ISPBYRPWR",
        [32+12][1] = "ISPRGBPWR",
        [32+13][1] = "ISPMCFPWR",
        [32+14][1] = "ISPMWR0",
        [32+15][1] = "ISPYUVPWR",
        [32+16][1] = "ISPMCSCWR",
        [32+17][1] = "ISPGDCWR",
        [32+18][1] = "ISPLMEWR",
        [32+19][1] = "ISPMWR1",
        [32+20][1] = "ISPMWR2",
        [32+22][1] = "ISPXT1",
        [32+23][1] = "ISPIXT1",
        [32+26][1] = "JPEG1",
        [32+27][1] = "VPE1",
        [32+29][1] = "VCNU1",
        [32+30][1] = "VCN1",
};

static const char *mmhub_client_ids_v3_4[][2] = {
        [0][0] = "VMC",
        [4][0] = "DCEDMC",
        [5][0] = "MPXSP",
        [6][0] = "MPASP",
        [7][0] = "MP1",
        [8][0] = "MPM",
        [23][0] = "HDP",
        [24][0] = "LSDMA",
        [25][0] = "JPEG",
        [26][0] = "VPE",
        [27][0] = "VSCH",
        [28][0] = "VCNU",
        [30][0] = "VCNRD",
        [3][1] = "DCEDWB",
        [4][1] = "DCEDMC",
        [5][1] = "MPXSP",
        [6][1] = "MPASAP",
        [7][1] = "MP1",
        [8][1] = "MPM",
        [21][1] = "OSSSYS",
        [23][1] = "HDP",
        [24][1] = "LSDMA",
        [25][1] = "JPEG",
        [26][1] = "VPE",
        [27][1] = "VSCH",
        [29][1] = "VCNWR",
};

static uint32_t mmhub_v3_3_get_invalidate_req(unsigned int vmid,
                                                uint32_t flush_type)
{
        u32 req = 0;

        /* invalidate using legacy mode on vmid*/
        req = REG_SET_FIELD(req, MMVM_INVALIDATE_ENG0_REQ,
                            PER_VMID_INVALIDATE_REQ, 1 << vmid);
        req = REG_SET_FIELD(req, MMVM_INVALIDATE_ENG0_REQ, FLUSH_TYPE, flush_type ? : 1);
        req = REG_SET_FIELD(req, MMVM_INVALIDATE_ENG0_REQ, INVALIDATE_L2_PTES, 1);
        req = REG_SET_FIELD(req, MMVM_INVALIDATE_ENG0_REQ, INVALIDATE_L2_PDE0, 1);
        req = REG_SET_FIELD(req, MMVM_INVALIDATE_ENG0_REQ, INVALIDATE_L2_PDE1, 1);
        req = REG_SET_FIELD(req, MMVM_INVALIDATE_ENG0_REQ, INVALIDATE_L2_PDE2, 1);
        req = REG_SET_FIELD(req, MMVM_INVALIDATE_ENG0_REQ, INVALIDATE_L1_PTES, 1);
        req = REG_SET_FIELD(req, MMVM_INVALIDATE_ENG0_REQ,
                            CLEAR_PROTECTION_FAULT_STATUS_ADDR, 0);

        return req;
}

static void
mmhub_v3_3_print_l2_protection_fault_status(struct amdgpu_device *adev,
                                              uint32_t status)
{
        uint32_t cid, rw;
        const char *mmhub_cid = NULL;

        cid = REG_GET_FIELD(status,
                            MMVM_L2_PROTECTION_FAULT_STATUS, CID);
        rw = REG_GET_FIELD(status,
                           MMVM_L2_PROTECTION_FAULT_STATUS, RW);

        dev_err(adev->dev,
                "MMVM_L2_PROTECTION_FAULT_STATUS:0x%08X\n",
                status);

        switch (amdgpu_ip_version(adev, MMHUB_HWIP, 0)) {
        case IP_VERSION(3, 3, 0):
        case IP_VERSION(3, 3, 2):
                mmhub_cid = cid < ARRAY_SIZE(mmhub_client_ids_v3_3) ?
                            mmhub_client_ids_v3_3[cid][rw] :
                            cid == 0x140 ? "UMSCH" : NULL;
                break;
        case IP_VERSION(3, 3, 1):
                mmhub_cid = cid < ARRAY_SIZE(mmhub_client_ids_v3_3_1) ?
                            mmhub_client_ids_v3_3_1[cid][rw] :
                            cid == 0x140 ? "UMSCH" : NULL;
                break;
        case IP_VERSION(3, 4, 0):
                mmhub_cid = cid < ARRAY_SIZE(mmhub_client_ids_v3_4) ?
                        mmhub_client_ids_v3_4[cid][rw] :
                cid == 0x140 ? "UMSCH" : NULL;
                break;
        default:
                mmhub_cid = NULL;
                break;
        }

        dev_err(adev->dev, "\t Faulty UTCL2 client ID: %s (0x%x)\n",
                mmhub_cid ? mmhub_cid : "unknown", cid);
        dev_err(adev->dev, "\t MORE_FAULTS: 0x%lx\n",
                REG_GET_FIELD(status,
                MMVM_L2_PROTECTION_FAULT_STATUS, MORE_FAULTS));
        dev_err(adev->dev, "\t WALKER_ERROR: 0x%lx\n",
                REG_GET_FIELD(status,
                MMVM_L2_PROTECTION_FAULT_STATUS, WALKER_ERROR));
        dev_err(adev->dev, "\t PERMISSION_FAULTS: 0x%lx\n",
                REG_GET_FIELD(status,
                MMVM_L2_PROTECTION_FAULT_STATUS, PERMISSION_FAULTS));
        dev_err(adev->dev, "\t MAPPING_ERROR: 0x%lx\n",
                REG_GET_FIELD(status,
                MMVM_L2_PROTECTION_FAULT_STATUS, MAPPING_ERROR));
        dev_err(adev->dev, "\t RW: 0x%x\n", rw);
}

static void mmhub_v3_3_setup_vm_pt_regs(struct amdgpu_device *adev,
                                          uint32_t vmid,
                                          uint64_t page_table_base)
{
        struct amdgpu_vmhub *hub = &adev->vmhub[AMDGPU_MMHUB0(0)];

        WREG32_SOC15_OFFSET(MMHUB, 0, regMMVM_CONTEXT0_PAGE_TABLE_BASE_ADDR_LO32,
                            hub->ctx_addr_distance * vmid,
                            lower_32_bits(page_table_base));

        WREG32_SOC15_OFFSET(MMHUB, 0, regMMVM_CONTEXT0_PAGE_TABLE_BASE_ADDR_HI32,
                            hub->ctx_addr_distance * vmid,
                            upper_32_bits(page_table_base));

}

static void mmhub_v3_3_init_gart_aperture_regs(struct amdgpu_device *adev)
{
        uint64_t pt_base = amdgpu_gmc_pd_addr(adev->gart.bo);

        mmhub_v3_3_setup_vm_pt_regs(adev, 0, pt_base);

        WREG32_SOC15(MMHUB, 0, regMMVM_CONTEXT0_PAGE_TABLE_START_ADDR_LO32,
                     (u32)(adev->gmc.gart_start >> 12));
        WREG32_SOC15(MMHUB, 0, regMMVM_CONTEXT0_PAGE_TABLE_START_ADDR_HI32,
                     (u32)(adev->gmc.gart_start >> 44));

        WREG32_SOC15(MMHUB, 0, regMMVM_CONTEXT0_PAGE_TABLE_END_ADDR_LO32,
                     (u32)(adev->gmc.gart_end >> 12));
        WREG32_SOC15(MMHUB, 0, regMMVM_CONTEXT0_PAGE_TABLE_END_ADDR_HI32,
                     (u32)(adev->gmc.gart_end >> 44));
}

static void mmhub_v3_3_init_system_aperture_regs(struct amdgpu_device *adev)
{
        uint64_t value;
        uint32_t tmp;

        /* Program the AGP BAR */
        WREG32_SOC15(MMHUB, 0, regMMMC_VM_AGP_BASE, 0);
        WREG32_SOC15(MMHUB, 0, regMMMC_VM_AGP_BOT, adev->gmc.agp_start >> 24);
        WREG32_SOC15(MMHUB, 0, regMMMC_VM_AGP_TOP, adev->gmc.agp_end >> 24);

        /*
         * the new L1 policy will block SRIOV guest from writing
         * these regs, and they will be programed at host.
         * so skip programing these regs.
         */
        /* Program the system aperture low logical page number. */
        WREG32_SOC15(MMHUB, 0, regMMMC_VM_SYSTEM_APERTURE_LOW_ADDR,
                     min(adev->gmc.fb_start, adev->gmc.agp_start) >> 18);
        WREG32_SOC15(MMHUB, 0, regMMMC_VM_SYSTEM_APERTURE_HIGH_ADDR,
                     max(adev->gmc.fb_end, adev->gmc.agp_end) >> 18);

        /* Set default page address. */
        value = amdgpu_gmc_vram_mc2pa(adev, adev->mem_scratch.gpu_addr);
        WREG32_SOC15(MMHUB, 0, regMMMC_VM_SYSTEM_APERTURE_DEFAULT_ADDR_LSB,
                     (u32)(value >> 12));
        WREG32_SOC15(MMHUB, 0, regMMMC_VM_SYSTEM_APERTURE_DEFAULT_ADDR_MSB,
                     (u32)(value >> 44));

        /* Program "protection fault". */
        WREG32_SOC15(MMHUB, 0, regMMVM_L2_PROTECTION_FAULT_DEFAULT_ADDR_LO32,
                     (u32)(adev->dummy_page_addr >> 12));
        WREG32_SOC15(MMHUB, 0, regMMVM_L2_PROTECTION_FAULT_DEFAULT_ADDR_HI32,
                     (u32)((u64)adev->dummy_page_addr >> 44));

        tmp = RREG32_SOC15(MMHUB, 0, regMMVM_L2_PROTECTION_FAULT_CNTL2);
        tmp = REG_SET_FIELD(tmp, MMVM_L2_PROTECTION_FAULT_CNTL2,
                            ACTIVE_PAGE_MIGRATION_PTE_READ_RETRY, 1);
        WREG32_SOC15(MMHUB, 0, regMMVM_L2_PROTECTION_FAULT_CNTL2, tmp);
}

static void mmhub_v3_3_init_tlb_regs(struct amdgpu_device *adev)
{
        uint32_t tmp;

        /* Setup TLB control */
        tmp = RREG32_SOC15(MMHUB, 0, regMMMC_VM_MX_L1_TLB_CNTL);

        tmp = REG_SET_FIELD(tmp, MMMC_VM_MX_L1_TLB_CNTL, ENABLE_L1_TLB, 1);
        tmp = REG_SET_FIELD(tmp, MMMC_VM_MX_L1_TLB_CNTL, SYSTEM_ACCESS_MODE, 3);
        tmp = REG_SET_FIELD(tmp, MMMC_VM_MX_L1_TLB_CNTL,
                            ENABLE_ADVANCED_DRIVER_MODEL, 1);
        tmp = REG_SET_FIELD(tmp, MMMC_VM_MX_L1_TLB_CNTL,
                            SYSTEM_APERTURE_UNMAPPED_ACCESS, 0);
        tmp = REG_SET_FIELD(tmp, MMMC_VM_MX_L1_TLB_CNTL, ECO_BITS, 0);
        tmp = REG_SET_FIELD(tmp, MMMC_VM_MX_L1_TLB_CNTL,
                            MTYPE, MTYPE_UC); /* UC, uncached */

        WREG32_SOC15(MMHUB, 0, regMMMC_VM_MX_L1_TLB_CNTL, tmp);
}

static void mmhub_v3_3_init_cache_regs(struct amdgpu_device *adev)
{
        uint32_t tmp;

        /* Setup L2 cache */
        tmp = RREG32_SOC15(MMHUB, 0, regMMVM_L2_CNTL);
        tmp = REG_SET_FIELD(tmp, MMVM_L2_CNTL, ENABLE_L2_CACHE, 1);
        tmp = REG_SET_FIELD(tmp, MMVM_L2_CNTL, ENABLE_L2_FRAGMENT_PROCESSING, 0);
        tmp = REG_SET_FIELD(tmp, MMVM_L2_CNTL,
                            ENABLE_DEFAULT_PAGE_OUT_TO_SYSTEM_MEMORY, 1);
        /* XXX for emulation, Refer to closed source code.*/
        tmp = REG_SET_FIELD(tmp, MMVM_L2_CNTL, L2_PDE0_CACHE_TAG_GENERATION_MODE,
                            0);
        tmp = REG_SET_FIELD(tmp, MMVM_L2_CNTL, PDE_FAULT_CLASSIFICATION, 0);
        tmp = REG_SET_FIELD(tmp, MMVM_L2_CNTL, CONTEXT1_IDENTITY_ACCESS_MODE, 1);
        tmp = REG_SET_FIELD(tmp, MMVM_L2_CNTL, IDENTITY_MODE_FRAGMENT_SIZE, 0);
        WREG32_SOC15(MMHUB, 0, regMMVM_L2_CNTL, tmp);

        tmp = RREG32_SOC15(MMHUB, 0, regMMVM_L2_CNTL2);
        tmp = REG_SET_FIELD(tmp, MMVM_L2_CNTL2, INVALIDATE_ALL_L1_TLBS, 1);
        tmp = REG_SET_FIELD(tmp, MMVM_L2_CNTL2, INVALIDATE_L2_CACHE, 1);
        WREG32_SOC15(MMHUB, 0, regMMVM_L2_CNTL2, tmp);

        tmp = regMMVM_L2_CNTL3_DEFAULT;
        if (adev->gmc.translate_further) {
                tmp = REG_SET_FIELD(tmp, MMVM_L2_CNTL3, BANK_SELECT, 12);
                tmp = REG_SET_FIELD(tmp, MMVM_L2_CNTL3,
                                    L2_CACHE_BIGK_FRAGMENT_SIZE, 9);
        } else {
                tmp = REG_SET_FIELD(tmp, MMVM_L2_CNTL3, BANK_SELECT, 9);
                tmp = REG_SET_FIELD(tmp, MMVM_L2_CNTL3,
                                    L2_CACHE_BIGK_FRAGMENT_SIZE, 6);
        }
        WREG32_SOC15(MMHUB, 0, regMMVM_L2_CNTL3, tmp);

        tmp = regMMVM_L2_CNTL4_DEFAULT;
        tmp = REG_SET_FIELD(tmp, MMVM_L2_CNTL4, VMC_TAP_PDE_REQUEST_PHYSICAL, 0);
        tmp = REG_SET_FIELD(tmp, MMVM_L2_CNTL4, VMC_TAP_PTE_REQUEST_PHYSICAL, 0);
        WREG32_SOC15(MMHUB, 0, regMMVM_L2_CNTL4, tmp);

        tmp = regMMVM_L2_CNTL5_DEFAULT;
        tmp = REG_SET_FIELD(tmp, MMVM_L2_CNTL5, L2_CACHE_SMALLK_FRAGMENT_SIZE, 0);
        WREG32_SOC15(MMHUB, 0, regMMVM_L2_CNTL5, tmp);
}

static void mmhub_v3_3_enable_system_domain(struct amdgpu_device *adev)
{
        uint32_t tmp;

        tmp = RREG32_SOC15(MMHUB, 0, regMMVM_CONTEXT0_CNTL);
        tmp = REG_SET_FIELD(tmp, MMVM_CONTEXT0_CNTL, ENABLE_CONTEXT, 1);
        tmp = REG_SET_FIELD(tmp, MMVM_CONTEXT0_CNTL, PAGE_TABLE_DEPTH, 0);
        tmp = REG_SET_FIELD(tmp, MMVM_CONTEXT0_CNTL,
                            RETRY_PERMISSION_OR_INVALID_PAGE_FAULT, 0);

        WREG32_SOC15(MMHUB, 0, regMMVM_CONTEXT0_CNTL, tmp);
}

static void mmhub_v3_3_disable_identity_aperture(struct amdgpu_device *adev)
{
        WREG32_SOC15(MMHUB, 0,
                     regMMVM_L2_CONTEXT1_IDENTITY_APERTURE_LOW_ADDR_LO32,
                     0xFFFFFFFF);
        WREG32_SOC15(MMHUB, 0,
                     regMMVM_L2_CONTEXT1_IDENTITY_APERTURE_LOW_ADDR_HI32,
                     0x0000000F);

        WREG32_SOC15(MMHUB, 0,
                     regMMVM_L2_CONTEXT1_IDENTITY_APERTURE_HIGH_ADDR_LO32, 0);
        WREG32_SOC15(MMHUB, 0,
                     regMMVM_L2_CONTEXT1_IDENTITY_APERTURE_HIGH_ADDR_HI32, 0);

        WREG32_SOC15(MMHUB, 0, regMMVM_L2_CONTEXT_IDENTITY_PHYSICAL_OFFSET_LO32,
                     0);
        WREG32_SOC15(MMHUB, 0, regMMVM_L2_CONTEXT_IDENTITY_PHYSICAL_OFFSET_HI32,
                     0);
}

static void mmhub_v3_3_setup_vmid_config(struct amdgpu_device *adev)
{
        struct amdgpu_vmhub *hub = &adev->vmhub[AMDGPU_MMHUB0(0)];
        int i;
        uint32_t tmp;

        for (i = 0; i <= 14; i++) {
                tmp = RREG32_SOC15_OFFSET(MMHUB, 0, regMMVM_CONTEXT1_CNTL, i * hub->ctx_distance);
                tmp = REG_SET_FIELD(tmp, MMVM_CONTEXT1_CNTL, ENABLE_CONTEXT, 1);
                tmp = REG_SET_FIELD(tmp, MMVM_CONTEXT1_CNTL, PAGE_TABLE_DEPTH,
                                    adev->vm_manager.num_level);
                tmp = REG_SET_FIELD(tmp, MMVM_CONTEXT1_CNTL,
                                    RANGE_PROTECTION_FAULT_ENABLE_DEFAULT, 1);
                tmp = REG_SET_FIELD(tmp, MMVM_CONTEXT1_CNTL,
                                    DUMMY_PAGE_PROTECTION_FAULT_ENABLE_DEFAULT,
                                    1);
                tmp = REG_SET_FIELD(tmp, MMVM_CONTEXT1_CNTL,
                                    PDE0_PROTECTION_FAULT_ENABLE_DEFAULT, 1);
                tmp = REG_SET_FIELD(tmp, MMVM_CONTEXT1_CNTL,
                                    VALID_PROTECTION_FAULT_ENABLE_DEFAULT, 1);
                tmp = REG_SET_FIELD(tmp, MMVM_CONTEXT1_CNTL,
                                    READ_PROTECTION_FAULT_ENABLE_DEFAULT, 1);
                tmp = REG_SET_FIELD(tmp, MMVM_CONTEXT1_CNTL,
                                    WRITE_PROTECTION_FAULT_ENABLE_DEFAULT, 1);
                tmp = REG_SET_FIELD(tmp, MMVM_CONTEXT1_CNTL,
                                    EXECUTE_PROTECTION_FAULT_ENABLE_DEFAULT, 1);
                tmp = REG_SET_FIELD(tmp, MMVM_CONTEXT1_CNTL,
                                    PAGE_TABLE_BLOCK_SIZE,
                                    adev->vm_manager.block_size - 9);
                /* Send no-retry XNACK on fault to suppress VM fault storm. */
                tmp = REG_SET_FIELD(tmp, MMVM_CONTEXT1_CNTL,
                                    RETRY_PERMISSION_OR_INVALID_PAGE_FAULT,
                                    !amdgpu_noretry);
                WREG32_SOC15_OFFSET(MMHUB, 0, regMMVM_CONTEXT1_CNTL,
                                    i * hub->ctx_distance, tmp);
                WREG32_SOC15_OFFSET(MMHUB, 0, regMMVM_CONTEXT1_PAGE_TABLE_START_ADDR_LO32,
                                    i * hub->ctx_addr_distance, 0);
                WREG32_SOC15_OFFSET(MMHUB, 0, regMMVM_CONTEXT1_PAGE_TABLE_START_ADDR_HI32,
                                    i * hub->ctx_addr_distance, 0);
                WREG32_SOC15_OFFSET(MMHUB, 0, regMMVM_CONTEXT1_PAGE_TABLE_END_ADDR_LO32,
                                    i * hub->ctx_addr_distance,
                                    lower_32_bits(adev->vm_manager.max_pfn - 1));
                WREG32_SOC15_OFFSET(MMHUB, 0, regMMVM_CONTEXT1_PAGE_TABLE_END_ADDR_HI32,
                                    i * hub->ctx_addr_distance,
                                    upper_32_bits(adev->vm_manager.max_pfn - 1));
        }

        hub->vm_cntx_cntl = tmp;
}

static void mmhub_v3_3_program_invalidation(struct amdgpu_device *adev)
{
        struct amdgpu_vmhub *hub = &adev->vmhub[AMDGPU_MMHUB0(0)];
        unsigned int i;

        for (i = 0; i < 18; ++i) {
                WREG32_SOC15_OFFSET(MMHUB, 0, regMMVM_INVALIDATE_ENG0_ADDR_RANGE_LO32,
                                    i * hub->eng_addr_distance, 0xffffffff);
                WREG32_SOC15_OFFSET(MMHUB, 0, regMMVM_INVALIDATE_ENG0_ADDR_RANGE_HI32,
                                    i * hub->eng_addr_distance, 0x1f);
        }
}

static void mmhub_v3_3_init_saw_regs(struct amdgpu_device *adev)
{
        uint64_t pt_base = amdgpu_gmc_pd_addr(adev->gart.bo);
        uint32_t tmp;

        /* Program page table base, gart start, gart end */
        WREG32_SOC15(MMHUB, 0, regMMVM_L2_SAW_CONTEXT0_PAGE_TABLE_BASE_ADDR_LO32,
                        lower_32_bits(pt_base >> 12));
        WREG32_SOC15(MMHUB, 0, regMMVM_L2_SAW_CONTEXT0_PAGE_TABLE_BASE_ADDR_HI32,
                        upper_32_bits(pt_base >> 12));

        WREG32_SOC15(MMHUB, 0, regMMVM_L2_SAW_CONTEXT0_PAGE_TABLE_START_ADDR_LO32,
                     (u32)(adev->gmc.gart_start >> 12));
        WREG32_SOC15(MMHUB, 0, regMMVM_L2_SAW_CONTEXT0_PAGE_TABLE_START_ADDR_HI32,
                     (u32)(adev->gmc.gart_start >> 44));

        WREG32_SOC15(MMHUB, 0, regMMVM_L2_SAW_CONTEXT0_PAGE_TABLE_END_ADDR_LO32,
                     (u32)(adev->gmc.gart_end >> 12));
        WREG32_SOC15(MMHUB, 0, regMMVM_L2_SAW_CONTEXT0_PAGE_TABLE_END_ADDR_HI32,
                     (u32)(adev->gmc.gart_end >> 44));

        tmp = RREG32_SOC15(MMHUB, 0, regMMVM_L2_SAW_CONTEXT0_CNTL);
        tmp = REG_SET_FIELD(tmp, MMVM_L2_SAW_CONTEXT0_CNTL, ENABLE_CONTEXT, 1);
        tmp = REG_SET_FIELD(tmp, MMVM_L2_SAW_CONTEXT0_CNTL, PAGE_TABLE_DEPTH, 0);
        WREG32_SOC15(MMHUB, 0, regMMVM_L2_SAW_CONTEXT0_CNTL, tmp);

        /* Disable all contexts except context 0 */
        tmp = 0xfffe;
        WREG32_SOC15(MMHUB, 0, regMMVM_L2_SAW_CONTEXTS_DISABLE, tmp);

        /* Program saw cntl4 */
        tmp = RREG32_SOC15(MMHUB, 0, regMMVM_L2_SAW_CNTL4);
        tmp = REG_SET_FIELD(tmp, MMVM_L2_SAW_CNTL4, VMC_TAP_CONTEXT0_PDE_REQUEST_SNOOP, 1);
        tmp = REG_SET_FIELD(tmp, MMVM_L2_SAW_CNTL4, VMC_TAP_CONTEXT0_PTE_REQUEST_SNOOP, 1);
        WREG32_SOC15(MMHUB, 0, regMMVM_L2_SAW_CNTL4, tmp);
}

static void mmhub_v3_3_enable_tls(struct amdgpu_device *adev)
{
        WREG32_SOC15(MMHUB, 0, regDAGB0_L1TLB_REG_RW_3_3, 0);
        WREG32_SOC15(MMHUB, 0, regDAGB1_L1TLB_REG_RW_3_3, 3);
}

static int mmhub_v3_3_gart_enable(struct amdgpu_device *adev)
{
        /* GART Enable. */
        mmhub_v3_3_init_gart_aperture_regs(adev);
        mmhub_v3_3_init_system_aperture_regs(adev);
        mmhub_v3_3_init_tlb_regs(adev);
        mmhub_v3_3_init_cache_regs(adev);

        mmhub_v3_3_enable_system_domain(adev);
        mmhub_v3_3_disable_identity_aperture(adev);
        mmhub_v3_3_setup_vmid_config(adev);
        mmhub_v3_3_program_invalidation(adev);

        /* standalone alone walker init */
        mmhub_v3_3_init_saw_regs(adev);

        /* enable mmhub tls */
        mmhub_v3_3_enable_tls(adev);

        return 0;
}

static void mmhub_v3_3_gart_disable(struct amdgpu_device *adev)
{
        struct amdgpu_vmhub *hub = &adev->vmhub[AMDGPU_MMHUB0(0)];
        u32 tmp;
        u32 i;

        /* Disable all tables */
        for (i = 0; i < 16; i++)
                WREG32_SOC15_OFFSET(MMHUB, 0, regMMVM_CONTEXT0_CNTL,
                                    i * hub->ctx_distance, 0);

        /* Setup TLB control */
        tmp = RREG32_SOC15(MMHUB, 0, regMMMC_VM_MX_L1_TLB_CNTL);
        tmp = REG_SET_FIELD(tmp, MMMC_VM_MX_L1_TLB_CNTL, ENABLE_L1_TLB, 0);
        tmp = REG_SET_FIELD(tmp, MMMC_VM_MX_L1_TLB_CNTL,
                            ENABLE_ADVANCED_DRIVER_MODEL, 0);
        WREG32_SOC15(MMHUB, 0, regMMMC_VM_MX_L1_TLB_CNTL, tmp);

        /* Setup L2 cache */
        tmp = RREG32_SOC15(MMHUB, 0, regMMVM_L2_CNTL);
        tmp = REG_SET_FIELD(tmp, MMVM_L2_CNTL, ENABLE_L2_CACHE, 0);
        WREG32_SOC15(MMHUB, 0, regMMVM_L2_CNTL, tmp);
        WREG32_SOC15(MMHUB, 0, regMMVM_L2_CNTL3, 0);
}

/**
 * mmhub_v3_3_set_fault_enable_default - update GART/VM fault handling
 *
 * @adev: amdgpu_device pointer
 * @value: true redirects VM faults to the default page
 */
static void mmhub_v3_3_set_fault_enable_default(struct amdgpu_device *adev,
                                                  bool value)
{
        u32 tmp;

        tmp = RREG32_SOC15(MMHUB, 0, regMMVM_L2_PROTECTION_FAULT_CNTL);
        tmp = REG_SET_FIELD(tmp, MMVM_L2_PROTECTION_FAULT_CNTL,
                            RANGE_PROTECTION_FAULT_ENABLE_DEFAULT, value);
        tmp = REG_SET_FIELD(tmp, MMVM_L2_PROTECTION_FAULT_CNTL,
                            PDE0_PROTECTION_FAULT_ENABLE_DEFAULT, value);
        tmp = REG_SET_FIELD(tmp, MMVM_L2_PROTECTION_FAULT_CNTL,
                            PDE1_PROTECTION_FAULT_ENABLE_DEFAULT, value);
        tmp = REG_SET_FIELD(tmp, MMVM_L2_PROTECTION_FAULT_CNTL,
                            PDE2_PROTECTION_FAULT_ENABLE_DEFAULT, value);
        tmp = REG_SET_FIELD(tmp, MMVM_L2_PROTECTION_FAULT_CNTL,
                            TRANSLATE_FURTHER_PROTECTION_FAULT_ENABLE_DEFAULT,
                            value);
        tmp = REG_SET_FIELD(tmp, MMVM_L2_PROTECTION_FAULT_CNTL,
                            NACK_PROTECTION_FAULT_ENABLE_DEFAULT, value);
        tmp = REG_SET_FIELD(tmp, MMVM_L2_PROTECTION_FAULT_CNTL,
                            DUMMY_PAGE_PROTECTION_FAULT_ENABLE_DEFAULT, value);
        tmp = REG_SET_FIELD(tmp, MMVM_L2_PROTECTION_FAULT_CNTL,
                            VALID_PROTECTION_FAULT_ENABLE_DEFAULT, value);
        tmp = REG_SET_FIELD(tmp, MMVM_L2_PROTECTION_FAULT_CNTL,
                            READ_PROTECTION_FAULT_ENABLE_DEFAULT, value);
        tmp = REG_SET_FIELD(tmp, MMVM_L2_PROTECTION_FAULT_CNTL,
                            WRITE_PROTECTION_FAULT_ENABLE_DEFAULT, value);
        tmp = REG_SET_FIELD(tmp, MMVM_L2_PROTECTION_FAULT_CNTL,
                            EXECUTE_PROTECTION_FAULT_ENABLE_DEFAULT, value);
        if (!value) {
                tmp = REG_SET_FIELD(tmp, MMVM_L2_PROTECTION_FAULT_CNTL,
                                CRASH_ON_NO_RETRY_FAULT, 1);
                tmp = REG_SET_FIELD(tmp, MMVM_L2_PROTECTION_FAULT_CNTL,
                                CRASH_ON_RETRY_FAULT, 1);
        }
        WREG32_SOC15(MMHUB, 0, regMMVM_L2_PROTECTION_FAULT_CNTL, tmp);
}

static const struct amdgpu_vmhub_funcs mmhub_v3_3_vmhub_funcs = {
        .print_l2_protection_fault_status = mmhub_v3_3_print_l2_protection_fault_status,
        .get_invalidate_req = mmhub_v3_3_get_invalidate_req,
};

static void mmhub_v3_3_init(struct amdgpu_device *adev)
{
        struct amdgpu_vmhub *hub = &adev->vmhub[AMDGPU_MMHUB0(0)];

        hub->ctx0_ptb_addr_lo32 =
                SOC15_REG_OFFSET(MMHUB, 0,
                                 regMMVM_CONTEXT0_PAGE_TABLE_BASE_ADDR_LO32);
        hub->ctx0_ptb_addr_hi32 =
                SOC15_REG_OFFSET(MMHUB, 0,
                                 regMMVM_CONTEXT0_PAGE_TABLE_BASE_ADDR_HI32);
        hub->vm_inv_eng0_sem =
                SOC15_REG_OFFSET(MMHUB, 0, regMMVM_INVALIDATE_ENG0_SEM);
        hub->vm_inv_eng0_req =
                SOC15_REG_OFFSET(MMHUB, 0, regMMVM_INVALIDATE_ENG0_REQ);
        hub->vm_inv_eng0_ack =
                SOC15_REG_OFFSET(MMHUB, 0, regMMVM_INVALIDATE_ENG0_ACK);
        hub->vm_context0_cntl =
                SOC15_REG_OFFSET(MMHUB, 0, regMMVM_CONTEXT0_CNTL);
        hub->vm_l2_pro_fault_status =
                SOC15_REG_OFFSET(MMHUB, 0, regMMVM_L2_PROTECTION_FAULT_STATUS);
        hub->vm_l2_pro_fault_cntl =
                SOC15_REG_OFFSET(MMHUB, 0, regMMVM_L2_PROTECTION_FAULT_CNTL);

        hub->ctx_distance = regMMVM_CONTEXT1_CNTL - regMMVM_CONTEXT0_CNTL;
        hub->ctx_addr_distance = regMMVM_CONTEXT1_PAGE_TABLE_BASE_ADDR_LO32 -
                regMMVM_CONTEXT0_PAGE_TABLE_BASE_ADDR_LO32;
        hub->eng_distance = regMMVM_INVALIDATE_ENG1_REQ -
                regMMVM_INVALIDATE_ENG0_REQ;
        hub->eng_addr_distance = regMMVM_INVALIDATE_ENG1_ADDR_RANGE_LO32 -
                regMMVM_INVALIDATE_ENG0_ADDR_RANGE_LO32;

        hub->vm_cntx_cntl_vm_fault = MMVM_CONTEXT1_CNTL__RANGE_PROTECTION_FAULT_ENABLE_INTERRUPT_MASK |
                MMVM_CONTEXT1_CNTL__DUMMY_PAGE_PROTECTION_FAULT_ENABLE_INTERRUPT_MASK |
                MMVM_CONTEXT1_CNTL__PDE0_PROTECTION_FAULT_ENABLE_INTERRUPT_MASK |
                MMVM_CONTEXT1_CNTL__VALID_PROTECTION_FAULT_ENABLE_INTERRUPT_MASK |
                MMVM_CONTEXT1_CNTL__READ_PROTECTION_FAULT_ENABLE_INTERRUPT_MASK |
                MMVM_CONTEXT1_CNTL__WRITE_PROTECTION_FAULT_ENABLE_INTERRUPT_MASK |
                MMVM_CONTEXT1_CNTL__EXECUTE_PROTECTION_FAULT_ENABLE_INTERRUPT_MASK;

        hub->vmhub_funcs = &mmhub_v3_3_vmhub_funcs;
}

static u64 mmhub_v3_3_get_fb_location(struct amdgpu_device *adev)
{
        u64 base;

        base = RREG32_SOC15(MMHUB, 0, regMMMC_VM_FB_LOCATION_BASE);
        base &= MMMC_VM_FB_LOCATION_BASE__FB_BASE_MASK;
        base <<= 24;

        return base;
}

static u64 mmhub_v3_3_get_mc_fb_offset(struct amdgpu_device *adev)
{
        u64 offset;

        offset = RREG32_SOC15(MMHUB, 0, regMMMC_VM_FB_OFFSET);
        offset &= MMMC_VM_FB_OFFSET__FB_OFFSET_MASK;
        offset <<= 24;

        return offset;
}

static void mmhub_v3_3_update_medium_grain_clock_gating(struct amdgpu_device *adev,
                                                          bool enable)
{
        uint32_t def, data;

        def = data = RREG32_SOC15(MMHUB, 0, regMM_ATC_L2_MISC_CG);

        if (enable)
                data |= MM_ATC_L2_MISC_CG__ENABLE_MASK;
        else
                data &= ~MM_ATC_L2_MISC_CG__ENABLE_MASK;

        if (def != data)
                WREG32_SOC15(MMHUB, 0, regMM_ATC_L2_MISC_CG, data);
}

static void mmhub_v3_3_update_medium_grain_light_sleep(struct amdgpu_device *adev,
                                                         bool enable)
{
        uint32_t def, data;

        def = data = RREG32_SOC15(MMHUB, 0, regMM_ATC_L2_MISC_CG);

        if (enable)
                data |= MM_ATC_L2_MISC_CG__MEM_LS_ENABLE_MASK;
        else
                data &= ~MM_ATC_L2_MISC_CG__MEM_LS_ENABLE_MASK;

        if (def != data)
                WREG32_SOC15(MMHUB, 0, regMM_ATC_L2_MISC_CG, data);
}

static int mmhub_v3_3_set_clockgating(struct amdgpu_device *adev,
                                        enum amd_clockgating_state state)
{
        if (amdgpu_sriov_vf(adev))
                return 0;

        mmhub_v3_3_update_medium_grain_clock_gating(adev,
                        state == AMD_CG_STATE_GATE);
        mmhub_v3_3_update_medium_grain_light_sleep(adev,
                        state == AMD_CG_STATE_GATE);
        return 0;
}

static void mmhub_v3_3_get_clockgating(struct amdgpu_device *adev, u64 *flags)
{
        u32 data;

        if (amdgpu_sriov_vf(adev))
                *flags = 0;

        data = RREG32_SOC15(MMHUB, 0, regMM_ATC_L2_MISC_CG);

        /* AMD_CG_SUPPORT_MC_MGCG */
        if (data & MM_ATC_L2_MISC_CG__ENABLE_MASK)
                *flags |= AMD_CG_SUPPORT_MC_MGCG;

        /* AMD_CG_SUPPORT_MC_LS */
        if (data & MM_ATC_L2_MISC_CG__MEM_LS_ENABLE_MASK)
                *flags |= AMD_CG_SUPPORT_MC_LS;
}

const struct amdgpu_mmhub_funcs mmhub_v3_3_funcs = {
        .init = mmhub_v3_3_init,
        .get_fb_location = mmhub_v3_3_get_fb_location,
        .get_mc_fb_offset = mmhub_v3_3_get_mc_fb_offset,
        .gart_enable = mmhub_v3_3_gart_enable,
        .set_fault_enable_default = mmhub_v3_3_set_fault_enable_default,
        .gart_disable = mmhub_v3_3_gart_disable,
        .set_clockgating = mmhub_v3_3_set_clockgating,
        .get_clockgating = mmhub_v3_3_get_clockgating,
        .setup_vm_pt_regs = mmhub_v3_3_setup_vm_pt_regs,
};