drivers/gpu/drm/amd/amdgpu/vcn_v2_5.c

root/drivers/gpu/drm/amd/amdgpu/vcn_v2_5.c
/*
 * Copyright 2019 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 <linux/firmware.h>
#include <drm/drm_drv.h>

#include "amdgpu.h"
#include "amdgpu_vcn.h"
#include "amdgpu_pm.h"
#include "soc15.h"
#include "soc15d.h"
#include "vcn_v2_0.h"
#include "mmsch_v1_0.h"
#include "vcn_v2_5.h"

#include "vcn/vcn_2_5_offset.h"
#include "vcn/vcn_2_5_sh_mask.h"
#include "ivsrcid/vcn/irqsrcs_vcn_2_0.h"

#define VCN_VID_SOC_ADDRESS_2_0                                 0x1fa00
#define VCN1_VID_SOC_ADDRESS_3_0                                0x48200
#define VCN1_AON_SOC_ADDRESS_3_0                                0x48000

#define mmUVD_CONTEXT_ID_INTERNAL_OFFSET                        0x27
#define mmUVD_GPCOM_VCPU_CMD_INTERNAL_OFFSET                    0x0f
#define mmUVD_GPCOM_VCPU_DATA0_INTERNAL_OFFSET                  0x10
#define mmUVD_GPCOM_VCPU_DATA1_INTERNAL_OFFSET                  0x11
#define mmUVD_NO_OP_INTERNAL_OFFSET                             0x29
#define mmUVD_GP_SCRATCH8_INTERNAL_OFFSET                       0x66
#define mmUVD_SCRATCH9_INTERNAL_OFFSET                          0xc01d

#define mmUVD_LMI_RBC_IB_VMID_INTERNAL_OFFSET                   0x431
#define mmUVD_LMI_RBC_IB_64BIT_BAR_LOW_INTERNAL_OFFSET          0x3b4
#define mmUVD_LMI_RBC_IB_64BIT_BAR_HIGH_INTERNAL_OFFSET         0x3b5
#define mmUVD_RBC_IB_SIZE_INTERNAL_OFFSET                       0x25c

#define VCN25_MAX_HW_INSTANCES_ARCTURUS                 2

static const struct amdgpu_hwip_reg_entry vcn_reg_list_2_5[] = {
        SOC15_REG_ENTRY_STR(VCN, 0, mmUVD_POWER_STATUS),
        SOC15_REG_ENTRY_STR(VCN, 0, mmUVD_POWER_STATUS),
        SOC15_REG_ENTRY_STR(VCN, 0, mmUVD_STATUS),
        SOC15_REG_ENTRY_STR(VCN, 0, mmUVD_CONTEXT_ID),
        SOC15_REG_ENTRY_STR(VCN, 0, mmUVD_CONTEXT_ID2),
        SOC15_REG_ENTRY_STR(VCN, 0, mmUVD_GPCOM_VCPU_DATA0),
        SOC15_REG_ENTRY_STR(VCN, 0, mmUVD_GPCOM_VCPU_DATA1),
        SOC15_REG_ENTRY_STR(VCN, 0, mmUVD_GPCOM_VCPU_CMD),
        SOC15_REG_ENTRY_STR(VCN, 0, mmUVD_RB_BASE_HI),
        SOC15_REG_ENTRY_STR(VCN, 0, mmUVD_RB_BASE_LO),
        SOC15_REG_ENTRY_STR(VCN, 0, mmUVD_RB_BASE_HI2),
        SOC15_REG_ENTRY_STR(VCN, 0, mmUVD_RB_BASE_LO2),
        SOC15_REG_ENTRY_STR(VCN, 0, mmUVD_RB_BASE_HI3),
        SOC15_REG_ENTRY_STR(VCN, 0, mmUVD_RB_BASE_LO3),
        SOC15_REG_ENTRY_STR(VCN, 0, mmUVD_RB_BASE_HI4),
        SOC15_REG_ENTRY_STR(VCN, 0, mmUVD_RB_BASE_LO4),
        SOC15_REG_ENTRY_STR(VCN, 0, mmUVD_RB_RPTR),
        SOC15_REG_ENTRY_STR(VCN, 0, mmUVD_RB_WPTR),
        SOC15_REG_ENTRY_STR(VCN, 0, mmUVD_RB_RPTR2),
        SOC15_REG_ENTRY_STR(VCN, 0, mmUVD_RB_WPTR2),
        SOC15_REG_ENTRY_STR(VCN, 0, mmUVD_RB_RPTR3),
        SOC15_REG_ENTRY_STR(VCN, 0, mmUVD_RB_WPTR3),
        SOC15_REG_ENTRY_STR(VCN, 0, mmUVD_RB_RPTR4),
        SOC15_REG_ENTRY_STR(VCN, 0, mmUVD_RB_WPTR4),
        SOC15_REG_ENTRY_STR(VCN, 0, mmUVD_RB_SIZE),
        SOC15_REG_ENTRY_STR(VCN, 0, mmUVD_RB_SIZE2),
        SOC15_REG_ENTRY_STR(VCN, 0, mmUVD_RB_SIZE3),
        SOC15_REG_ENTRY_STR(VCN, 0, mmUVD_RB_SIZE4),
        SOC15_REG_ENTRY_STR(VCN, 0, mmUVD_PGFSM_CONFIG),
        SOC15_REG_ENTRY_STR(VCN, 0, mmUVD_PGFSM_STATUS),
        SOC15_REG_ENTRY_STR(VCN, 0, mmUVD_DPG_LMA_CTL),
        SOC15_REG_ENTRY_STR(VCN, 0, mmUVD_DPG_LMA_DATA),
        SOC15_REG_ENTRY_STR(VCN, 0, mmUVD_DPG_LMA_MASK),
        SOC15_REG_ENTRY_STR(VCN, 0, mmUVD_DPG_PAUSE)
};

static void vcn_v2_5_set_dec_ring_funcs(struct amdgpu_device *adev);
static void vcn_v2_5_set_enc_ring_funcs(struct amdgpu_device *adev);
static void vcn_v2_5_set_irq_funcs(struct amdgpu_device *adev);
static int vcn_v2_5_set_pg_state(struct amdgpu_vcn_inst *vinst,
                                 enum amd_powergating_state state);
static int vcn_v2_5_pause_dpg_mode(struct amdgpu_vcn_inst *vinst,
                                   struct dpg_pause_state *new_state);
static int vcn_v2_5_sriov_start(struct amdgpu_device *adev);
static void vcn_v2_5_set_ras_funcs(struct amdgpu_device *adev);
static int vcn_v2_5_reset(struct amdgpu_vcn_inst *vinst);

static int amdgpu_ih_clientid_vcns[] = {
        SOC15_IH_CLIENTID_VCN,
        SOC15_IH_CLIENTID_VCN1
};

static void vcn_v2_5_idle_work_handler(struct work_struct *work)
{
        struct amdgpu_vcn_inst *vcn_inst =
                container_of(work, struct amdgpu_vcn_inst, idle_work.work);
        struct amdgpu_device *adev = vcn_inst->adev;
        unsigned int fences = 0, fence[AMDGPU_MAX_VCN_INSTANCES] = {0};
        unsigned int i, j;

        for (i = 0; i < adev->vcn.num_vcn_inst; ++i) {
                struct amdgpu_vcn_inst *v = &adev->vcn.inst[i];

                if (adev->vcn.harvest_config & (1 << i))
                        continue;

                for (j = 0; j < v->num_enc_rings; ++j)
                        fence[i] += amdgpu_fence_count_emitted(&v->ring_enc[j]);

                /* Only set DPG pause for VCN3 or below, VCN4 and above will be handled by FW */
                if (adev->pg_flags & AMD_PG_SUPPORT_VCN_DPG &&
                    !v->using_unified_queue) {
                        struct dpg_pause_state new_state;

                        if (fence[i] ||
                            unlikely(atomic_read(&v->dpg_enc_submission_cnt)))
                                new_state.fw_based = VCN_DPG_STATE__PAUSE;
                        else
                                new_state.fw_based = VCN_DPG_STATE__UNPAUSE;

                        v->pause_dpg_mode(v, &new_state);
                }

                fence[i] += amdgpu_fence_count_emitted(&v->ring_dec);
                fences += fence[i];

        }

        if (!fences && !atomic_read(&adev->vcn.inst[0].total_submission_cnt)) {
                amdgpu_device_ip_set_powergating_state(adev, AMD_IP_BLOCK_TYPE_VCN,
                                                       AMD_PG_STATE_GATE);
                amdgpu_vcn_put_profile(adev);
        } else {
                schedule_delayed_work(&adev->vcn.inst[0].idle_work, VCN_IDLE_TIMEOUT);
        }
}

static void vcn_v2_5_ring_begin_use(struct amdgpu_ring *ring)
{
        struct amdgpu_device *adev = ring->adev;
        struct amdgpu_vcn_inst *v = &adev->vcn.inst[ring->me];

        atomic_inc(&adev->vcn.inst[0].total_submission_cnt);

        cancel_delayed_work_sync(&adev->vcn.inst[0].idle_work);

        /* We can safely return early here because we've cancelled the
         * the delayed work so there is no one else to set it to false
         * and we don't care if someone else sets it to true.
         */
        mutex_lock(&adev->vcn.inst[0].vcn_pg_lock);
        amdgpu_device_ip_set_powergating_state(adev, AMD_IP_BLOCK_TYPE_VCN,
                                               AMD_PG_STATE_UNGATE);

        /* Only set DPG pause for VCN3 or below, VCN4 and above will be handled by FW */
        if (adev->pg_flags & AMD_PG_SUPPORT_VCN_DPG &&
            !v->using_unified_queue) {
                struct dpg_pause_state new_state;

                if (ring->funcs->type == AMDGPU_RING_TYPE_VCN_ENC) {
                        atomic_inc(&v->dpg_enc_submission_cnt);
                        new_state.fw_based = VCN_DPG_STATE__PAUSE;
                } else {
                        unsigned int fences = 0;
                        unsigned int i;

                        for (i = 0; i < v->num_enc_rings; ++i)
                                fences += amdgpu_fence_count_emitted(&v->ring_enc[i]);

                        if (fences || atomic_read(&v->dpg_enc_submission_cnt))
                                new_state.fw_based = VCN_DPG_STATE__PAUSE;
                        else
                                new_state.fw_based = VCN_DPG_STATE__UNPAUSE;
                }
                v->pause_dpg_mode(v, &new_state);
        }
        mutex_unlock(&adev->vcn.inst[0].vcn_pg_lock);
        amdgpu_vcn_get_profile(adev);
}

static void vcn_v2_5_ring_end_use(struct amdgpu_ring *ring)
{
        struct amdgpu_device *adev = ring->adev;

        /* Only set DPG pause for VCN3 or below, VCN4 and above will be handled by FW */
        if (ring->adev->pg_flags & AMD_PG_SUPPORT_VCN_DPG &&
            ring->funcs->type == AMDGPU_RING_TYPE_VCN_ENC &&
            !adev->vcn.inst[ring->me].using_unified_queue)
                atomic_dec(&adev->vcn.inst[ring->me].dpg_enc_submission_cnt);

        atomic_dec(&adev->vcn.inst[0].total_submission_cnt);

        schedule_delayed_work(&adev->vcn.inst[0].idle_work,
                              VCN_IDLE_TIMEOUT);
}

/**
 * vcn_v2_5_early_init - set function pointers and load microcode
 *
 * @ip_block: Pointer to the amdgpu_ip_block for this hw instance.
 *
 * Set ring and irq function pointers
 * Load microcode from filesystem
 */
static int vcn_v2_5_early_init(struct amdgpu_ip_block *ip_block)
{
        struct amdgpu_device *adev = ip_block->adev;
        int i, r;

        if (amdgpu_sriov_vf(adev)) {
                adev->vcn.num_vcn_inst = 2;
                adev->vcn.harvest_config = 0;
                for (i = 0; i < adev->vcn.num_vcn_inst; i++)
                        adev->vcn.inst[i].num_enc_rings = 1;
        } else {
                u32 harvest;
                int i;

                for (i = 0; i < adev->vcn.num_vcn_inst; i++) {
                        harvest = RREG32_SOC15(VCN, i, mmCC_UVD_HARVESTING);
                        if (harvest & CC_UVD_HARVESTING__UVD_DISABLE_MASK)
                                adev->vcn.harvest_config |= 1 << i;
                        adev->vcn.inst[i].num_enc_rings = 2;
                }
                if (adev->vcn.harvest_config == (AMDGPU_VCN_HARVEST_VCN0 |
                                                 AMDGPU_VCN_HARVEST_VCN1))
                        /* both instances are harvested, disable the block */
                        return -ENOENT;
        }

        vcn_v2_5_set_dec_ring_funcs(adev);
        vcn_v2_5_set_enc_ring_funcs(adev);
        vcn_v2_5_set_irq_funcs(adev);
        vcn_v2_5_set_ras_funcs(adev);

        for (i = 0; i < adev->vcn.num_vcn_inst; i++) {
                adev->vcn.inst[i].set_pg_state = vcn_v2_5_set_pg_state;

                r = amdgpu_vcn_early_init(adev, i);
                if (r)
                        return r;
        }

        return 0;
}

/**
 * vcn_v2_5_sw_init - sw init for VCN block
 *
 * @ip_block: Pointer to the amdgpu_ip_block for this hw instance.
 *
 * Load firmware and sw initialization
 */
static int vcn_v2_5_sw_init(struct amdgpu_ip_block *ip_block)
{
        struct amdgpu_ring *ring;
        int i, j, r;
        struct amdgpu_device *adev = ip_block->adev;

        for (j = 0; j < adev->vcn.num_vcn_inst; j++) {
                struct amdgpu_fw_shared *fw_shared;

                if (adev->vcn.harvest_config & (1 << j))
                        continue;
                /* VCN DEC TRAP */
                r = amdgpu_irq_add_id(adev, amdgpu_ih_clientid_vcns[j],
                                VCN_2_0__SRCID__UVD_SYSTEM_MESSAGE_INTERRUPT, &adev->vcn.inst[j].irq);
                if (r)
                        return r;

                /* VCN ENC TRAP */
                for (i = 0; i < adev->vcn.inst[j].num_enc_rings; ++i) {
                        r = amdgpu_irq_add_id(adev, amdgpu_ih_clientid_vcns[j],
                                i + VCN_2_0__SRCID__UVD_ENC_GENERAL_PURPOSE, &adev->vcn.inst[j].irq);
                        if (r)
                                return r;
                }

                /* VCN POISON TRAP */
                r = amdgpu_irq_add_id(adev, amdgpu_ih_clientid_vcns[j],
                        VCN_2_6__SRCID_UVD_POISON, &adev->vcn.inst[j].ras_poison_irq);
                if (r)
                        return r;

                r = amdgpu_vcn_sw_init(adev, j);
                if (r)
                        return r;

                /* Override the work func */
                adev->vcn.inst[j].idle_work.work.func = vcn_v2_5_idle_work_handler;

                amdgpu_vcn_setup_ucode(adev, j);

                r = amdgpu_vcn_resume(adev, j);
                if (r)
                        return r;

                adev->vcn.inst[j].internal.context_id = mmUVD_CONTEXT_ID_INTERNAL_OFFSET;
                adev->vcn.inst[j].internal.ib_vmid = mmUVD_LMI_RBC_IB_VMID_INTERNAL_OFFSET;
                adev->vcn.inst[j].internal.ib_bar_low = mmUVD_LMI_RBC_IB_64BIT_BAR_LOW_INTERNAL_OFFSET;
                adev->vcn.inst[j].internal.ib_bar_high = mmUVD_LMI_RBC_IB_64BIT_BAR_HIGH_INTERNAL_OFFSET;
                adev->vcn.inst[j].internal.ib_size = mmUVD_RBC_IB_SIZE_INTERNAL_OFFSET;
                adev->vcn.inst[j].internal.gp_scratch8 = mmUVD_GP_SCRATCH8_INTERNAL_OFFSET;

                adev->vcn.inst[j].internal.scratch9 = mmUVD_SCRATCH9_INTERNAL_OFFSET;
                adev->vcn.inst[j].external.scratch9 = SOC15_REG_OFFSET(VCN, j, mmUVD_SCRATCH9);
                adev->vcn.inst[j].internal.data0 = mmUVD_GPCOM_VCPU_DATA0_INTERNAL_OFFSET;
                adev->vcn.inst[j].external.data0 = SOC15_REG_OFFSET(VCN, j, mmUVD_GPCOM_VCPU_DATA0);
                adev->vcn.inst[j].internal.data1 = mmUVD_GPCOM_VCPU_DATA1_INTERNAL_OFFSET;
                adev->vcn.inst[j].external.data1 = SOC15_REG_OFFSET(VCN, j, mmUVD_GPCOM_VCPU_DATA1);
                adev->vcn.inst[j].internal.cmd = mmUVD_GPCOM_VCPU_CMD_INTERNAL_OFFSET;
                adev->vcn.inst[j].external.cmd = SOC15_REG_OFFSET(VCN, j, mmUVD_GPCOM_VCPU_CMD);
                adev->vcn.inst[j].internal.nop = mmUVD_NO_OP_INTERNAL_OFFSET;
                adev->vcn.inst[j].external.nop = SOC15_REG_OFFSET(VCN, j, mmUVD_NO_OP);

                ring = &adev->vcn.inst[j].ring_dec;
                ring->use_doorbell = true;

                ring->doorbell_index = (adev->doorbell_index.vcn.vcn_ring0_1 << 1) +
                                (amdgpu_sriov_vf(adev) ? 2*j : 8*j);

                if (amdgpu_ip_version(adev, UVD_HWIP, 0) == IP_VERSION(2, 5, 0))
                        ring->vm_hub = AMDGPU_MMHUB1(0);
                else
                        ring->vm_hub = AMDGPU_MMHUB0(0);

                sprintf(ring->name, "vcn_dec_%d", j);
                r = amdgpu_ring_init(adev, ring, 512, &adev->vcn.inst[j].irq,
                                     0, AMDGPU_RING_PRIO_DEFAULT, NULL);
                if (r)
                        return r;

                for (i = 0; i < adev->vcn.inst[j].num_enc_rings; ++i) {
                        enum amdgpu_ring_priority_level hw_prio = amdgpu_vcn_get_enc_ring_prio(i);

                        ring = &adev->vcn.inst[j].ring_enc[i];
                        ring->use_doorbell = true;

                        ring->doorbell_index = (adev->doorbell_index.vcn.vcn_ring0_1 << 1) +
                                        (amdgpu_sriov_vf(adev) ? (1 + i + 2*j) : (2 + i + 8*j));

                        if (amdgpu_ip_version(adev, UVD_HWIP, 0) ==
                            IP_VERSION(2, 5, 0))
                                ring->vm_hub = AMDGPU_MMHUB1(0);
                        else
                                ring->vm_hub = AMDGPU_MMHUB0(0);

                        sprintf(ring->name, "vcn_enc_%d.%d", j, i);
                        r = amdgpu_ring_init(adev, ring, 512,
                                             &adev->vcn.inst[j].irq, 0,
                                             hw_prio, NULL);
                        if (r)
                                return r;
                }

                fw_shared = adev->vcn.inst[j].fw_shared.cpu_addr;
                fw_shared->present_flag_0 = cpu_to_le32(AMDGPU_VCN_MULTI_QUEUE_FLAG);

                if (amdgpu_vcnfw_log)
                        amdgpu_vcn_fwlog_init(&adev->vcn.inst[i]);

                if (adev->pg_flags & AMD_PG_SUPPORT_VCN_DPG)
                        adev->vcn.inst[j].pause_dpg_mode = vcn_v2_5_pause_dpg_mode;
                adev->vcn.inst[j].reset = vcn_v2_5_reset;
        }

        adev->vcn.supported_reset =
                amdgpu_get_soft_full_reset_mask(&adev->vcn.inst[0].ring_enc[0]);
        if (!amdgpu_sriov_vf(adev))
                adev->vcn.supported_reset |= AMDGPU_RESET_TYPE_PER_QUEUE;

        if (amdgpu_sriov_vf(adev)) {
                r = amdgpu_virt_alloc_mm_table(adev);
                if (r)
                        return r;
        }

        r = amdgpu_vcn_ras_sw_init(adev);
        if (r)
                return r;

        r = amdgpu_vcn_reg_dump_init(adev, vcn_reg_list_2_5, ARRAY_SIZE(vcn_reg_list_2_5));
        if (r)
                return r;

        r = amdgpu_vcn_sysfs_reset_mask_init(adev);
        if (r)
                return r;

        return 0;
}

/**
 * vcn_v2_5_sw_fini - sw fini for VCN block
 *
 * @ip_block: Pointer to the amdgpu_ip_block for this hw instance.
 *
 * VCN suspend and free up sw allocation
 */
static int vcn_v2_5_sw_fini(struct amdgpu_ip_block *ip_block)
{
        int i, r, idx;
        struct amdgpu_device *adev = ip_block->adev;
        struct amdgpu_fw_shared *fw_shared;

        if (drm_dev_enter(adev_to_drm(adev), &idx)) {
                for (i = 0; i < adev->vcn.num_vcn_inst; i++) {
                        if (adev->vcn.harvest_config & (1 << i))
                                continue;
                        fw_shared = adev->vcn.inst[i].fw_shared.cpu_addr;
                        fw_shared->present_flag_0 = 0;
                }
                drm_dev_exit(idx);
        }


        if (amdgpu_sriov_vf(adev))
                amdgpu_virt_free_mm_table(adev);

        amdgpu_vcn_sysfs_reset_mask_fini(adev);

        for (i = 0; i < adev->vcn.num_vcn_inst; i++) {
                r = amdgpu_vcn_suspend(adev, i);
                if (r)
                        return r;
                amdgpu_vcn_sw_fini(adev, i);
        }

        return 0;
}

/**
 * vcn_v2_5_hw_init - start and test VCN block
 *
 * @ip_block: Pointer to the amdgpu_ip_block for this hw instance.
 *
 * Initialize the hardware, boot up the VCPU and do some testing
 */
static int vcn_v2_5_hw_init(struct amdgpu_ip_block *ip_block)
{
        struct amdgpu_device *adev = ip_block->adev;
        struct amdgpu_ring *ring;
        int i, j, r = 0;

        if (amdgpu_sriov_vf(adev))
                r = vcn_v2_5_sriov_start(adev);

        for (j = 0; j < adev->vcn.num_vcn_inst; ++j) {
                if (adev->vcn.harvest_config & (1 << j))
                        continue;

                if (amdgpu_sriov_vf(adev)) {
                        adev->vcn.inst[j].ring_enc[0].sched.ready = true;
                        adev->vcn.inst[j].ring_enc[1].sched.ready = false;
                        adev->vcn.inst[j].ring_enc[2].sched.ready = false;
                        adev->vcn.inst[j].ring_dec.sched.ready = true;
                } else {

                        ring = &adev->vcn.inst[j].ring_dec;

                        adev->nbio.funcs->vcn_doorbell_range(adev, ring->use_doorbell,
                                                     ring->doorbell_index, j);

                        r = amdgpu_ring_test_helper(ring);
                        if (r)
                                return r;

                        for (i = 0; i < adev->vcn.inst[j].num_enc_rings; ++i) {
                                ring = &adev->vcn.inst[j].ring_enc[i];
                                r = amdgpu_ring_test_helper(ring);
                                if (r)
                                        return r;
                        }
                }
        }

        return r;
}

/**
 * vcn_v2_5_hw_fini - stop the hardware block
 *
 * @ip_block: Pointer to the amdgpu_ip_block for this hw instance.
 *
 * Stop the VCN block, mark ring as not ready any more
 */
static int vcn_v2_5_hw_fini(struct amdgpu_ip_block *ip_block)
{
        struct amdgpu_device *adev = ip_block->adev;
        int i;

        for (i = 0; i < adev->vcn.num_vcn_inst; ++i) {
                struct amdgpu_vcn_inst *vinst = &adev->vcn.inst[i];

                if (adev->vcn.harvest_config & (1 << i))
                        continue;

                cancel_delayed_work_sync(&vinst->idle_work);

                if ((adev->pg_flags & AMD_PG_SUPPORT_VCN_DPG) ||
                    (vinst->cur_state != AMD_PG_STATE_GATE &&
                     RREG32_SOC15(VCN, i, mmUVD_STATUS)))
                        vinst->set_pg_state(vinst, AMD_PG_STATE_GATE);

                /* VF doesn't enable interrupt operations for RAS */
                if (!amdgpu_sriov_vf(adev) &&
                    amdgpu_ras_is_supported(adev, AMDGPU_RAS_BLOCK__VCN))
                        amdgpu_irq_put(adev, &vinst->ras_poison_irq, 0);
        }

        return 0;
}

/**
 * vcn_v2_5_suspend - suspend VCN block
 *
 * @ip_block: Pointer to the amdgpu_ip_block for this hw instance.
 *
 * HW fini and suspend VCN block
 */
static int vcn_v2_5_suspend(struct amdgpu_ip_block *ip_block)
{
        struct amdgpu_device *adev = ip_block->adev;
        int r, i;

        r = vcn_v2_5_hw_fini(ip_block);
        if (r)
                return r;

        for (i = 0; i < adev->vcn.num_vcn_inst; i++) {
                r = amdgpu_vcn_suspend(ip_block->adev, i);
                if (r)
                        return r;
        }

        return 0;
}

/**
 * vcn_v2_5_resume - resume VCN block
 *
 * @ip_block: Pointer to the amdgpu_ip_block for this hw instance.
 *
 * Resume firmware and hw init VCN block
 */
static int vcn_v2_5_resume(struct amdgpu_ip_block *ip_block)
{
        struct amdgpu_device *adev = ip_block->adev;
        int r, i;

        for (i = 0; i < adev->vcn.num_vcn_inst; i++) {
                r = amdgpu_vcn_resume(ip_block->adev, i);
                if (r)
                        return r;
        }

        r = vcn_v2_5_hw_init(ip_block);

        return r;
}

/**
 * vcn_v2_5_mc_resume - memory controller programming
 *
 * @vinst: VCN instance
 *
 * Let the VCN memory controller know it's offsets
 */
static void vcn_v2_5_mc_resume(struct amdgpu_vcn_inst *vinst)
{
        struct amdgpu_device *adev = vinst->adev;
        int i = vinst->inst;
        uint32_t size;
        uint32_t offset;

        if (adev->vcn.harvest_config & (1 << i))
                return;

        size = AMDGPU_GPU_PAGE_ALIGN(adev->vcn.inst[i].fw->size + 4);
        /* cache window 0: fw */
        if (adev->firmware.load_type == AMDGPU_FW_LOAD_PSP) {
                WREG32_SOC15(VCN, i, mmUVD_LMI_VCPU_CACHE_64BIT_BAR_LOW,
                             (adev->firmware.ucode[AMDGPU_UCODE_ID_VCN + i].tmr_mc_addr_lo));
                WREG32_SOC15(VCN, i, mmUVD_LMI_VCPU_CACHE_64BIT_BAR_HIGH,
                             (adev->firmware.ucode[AMDGPU_UCODE_ID_VCN + i].tmr_mc_addr_hi));
                WREG32_SOC15(VCN, i, mmUVD_VCPU_CACHE_OFFSET0, 0);
                offset = 0;
        } else {
                WREG32_SOC15(VCN, i, mmUVD_LMI_VCPU_CACHE_64BIT_BAR_LOW,
                             lower_32_bits(adev->vcn.inst[i].gpu_addr));
                WREG32_SOC15(VCN, i, mmUVD_LMI_VCPU_CACHE_64BIT_BAR_HIGH,
                             upper_32_bits(adev->vcn.inst[i].gpu_addr));
                offset = size;
                WREG32_SOC15(VCN, i, mmUVD_VCPU_CACHE_OFFSET0,
                             AMDGPU_UVD_FIRMWARE_OFFSET >> 3);
        }
        WREG32_SOC15(VCN, i, mmUVD_VCPU_CACHE_SIZE0, size);

        /* cache window 1: stack */
        WREG32_SOC15(VCN, i, mmUVD_LMI_VCPU_CACHE1_64BIT_BAR_LOW,
                     lower_32_bits(adev->vcn.inst[i].gpu_addr + offset));
        WREG32_SOC15(VCN, i, mmUVD_LMI_VCPU_CACHE1_64BIT_BAR_HIGH,
                     upper_32_bits(adev->vcn.inst[i].gpu_addr + offset));
        WREG32_SOC15(VCN, i, mmUVD_VCPU_CACHE_OFFSET1, 0);
        WREG32_SOC15(VCN, i, mmUVD_VCPU_CACHE_SIZE1, AMDGPU_VCN_STACK_SIZE);

        /* cache window 2: context */
        WREG32_SOC15(VCN, i, mmUVD_LMI_VCPU_CACHE2_64BIT_BAR_LOW,
                     lower_32_bits(adev->vcn.inst[i].gpu_addr + offset + AMDGPU_VCN_STACK_SIZE));
        WREG32_SOC15(VCN, i, mmUVD_LMI_VCPU_CACHE2_64BIT_BAR_HIGH,
                     upper_32_bits(adev->vcn.inst[i].gpu_addr + offset + AMDGPU_VCN_STACK_SIZE));
        WREG32_SOC15(VCN, i, mmUVD_VCPU_CACHE_OFFSET2, 0);
        WREG32_SOC15(VCN, i, mmUVD_VCPU_CACHE_SIZE2, AMDGPU_VCN_CONTEXT_SIZE);

        /* non-cache window */
        WREG32_SOC15(VCN, i, mmUVD_LMI_VCPU_NC0_64BIT_BAR_LOW,
                     lower_32_bits(adev->vcn.inst[i].fw_shared.gpu_addr));
        WREG32_SOC15(VCN, i, mmUVD_LMI_VCPU_NC0_64BIT_BAR_HIGH,
                     upper_32_bits(adev->vcn.inst[i].fw_shared.gpu_addr));
        WREG32_SOC15(VCN, i, mmUVD_VCPU_NONCACHE_OFFSET0, 0);
        WREG32_SOC15(VCN, i, mmUVD_VCPU_NONCACHE_SIZE0,
                     AMDGPU_GPU_PAGE_ALIGN(sizeof(struct amdgpu_fw_shared)));
}

static void vcn_v2_5_mc_resume_dpg_mode(struct amdgpu_vcn_inst *vinst,
                                        bool indirect)
{
        struct amdgpu_device *adev = vinst->adev;
        int inst_idx = vinst->inst;
        uint32_t size = AMDGPU_GPU_PAGE_ALIGN(adev->vcn.inst[inst_idx].fw->size + 4);
        uint32_t offset;

        /* cache window 0: fw */
        if (adev->firmware.load_type == AMDGPU_FW_LOAD_PSP) {
                if (!indirect) {
                        WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                                VCN, 0, mmUVD_LMI_VCPU_CACHE_64BIT_BAR_LOW),
                                (adev->firmware.ucode[AMDGPU_UCODE_ID_VCN + inst_idx].tmr_mc_addr_lo), 0, indirect);
                        WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                                VCN, 0, mmUVD_LMI_VCPU_CACHE_64BIT_BAR_HIGH),
                                (adev->firmware.ucode[AMDGPU_UCODE_ID_VCN + inst_idx].tmr_mc_addr_hi), 0, indirect);
                        WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                                VCN, 0, mmUVD_VCPU_CACHE_OFFSET0), 0, 0, indirect);
                } else {
                        WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                                VCN, 0, mmUVD_LMI_VCPU_CACHE_64BIT_BAR_LOW), 0, 0, indirect);
                        WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                                VCN, 0, mmUVD_LMI_VCPU_CACHE_64BIT_BAR_HIGH), 0, 0, indirect);
                        WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                                VCN, 0, mmUVD_VCPU_CACHE_OFFSET0), 0, 0, indirect);
                }
                offset = 0;
        } else {
                WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                        VCN, 0, mmUVD_LMI_VCPU_CACHE_64BIT_BAR_LOW),
                        lower_32_bits(adev->vcn.inst[inst_idx].gpu_addr), 0, indirect);
                WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                        VCN, 0, mmUVD_LMI_VCPU_CACHE_64BIT_BAR_HIGH),
                        upper_32_bits(adev->vcn.inst[inst_idx].gpu_addr), 0, indirect);
                offset = size;
                WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                        VCN, 0, mmUVD_VCPU_CACHE_OFFSET0),
                        AMDGPU_UVD_FIRMWARE_OFFSET >> 3, 0, indirect);
        }

        if (!indirect)
                WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                        VCN, 0, mmUVD_VCPU_CACHE_SIZE0), size, 0, indirect);
        else
                WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                        VCN, 0, mmUVD_VCPU_CACHE_SIZE0), 0, 0, indirect);

        /* cache window 1: stack */
        if (!indirect) {
                WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                        VCN, 0, mmUVD_LMI_VCPU_CACHE1_64BIT_BAR_LOW),
                        lower_32_bits(adev->vcn.inst[inst_idx].gpu_addr + offset), 0, indirect);
                WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                        VCN, 0, mmUVD_LMI_VCPU_CACHE1_64BIT_BAR_HIGH),
                        upper_32_bits(adev->vcn.inst[inst_idx].gpu_addr + offset), 0, indirect);
                WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                        VCN, 0, mmUVD_VCPU_CACHE_OFFSET1), 0, 0, indirect);
        } else {
                WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                        VCN, 0, mmUVD_LMI_VCPU_CACHE1_64BIT_BAR_LOW), 0, 0, indirect);
                WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                        VCN, 0, mmUVD_LMI_VCPU_CACHE1_64BIT_BAR_HIGH), 0, 0, indirect);
                WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                        VCN, 0, mmUVD_VCPU_CACHE_OFFSET1), 0, 0, indirect);
        }
        WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                VCN, 0, mmUVD_VCPU_CACHE_SIZE1), AMDGPU_VCN_STACK_SIZE, 0, indirect);

        /* cache window 2: context */
        WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                VCN, 0, mmUVD_LMI_VCPU_CACHE2_64BIT_BAR_LOW),
                lower_32_bits(adev->vcn.inst[inst_idx].gpu_addr + offset + AMDGPU_VCN_STACK_SIZE), 0, indirect);
        WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                VCN, 0, mmUVD_LMI_VCPU_CACHE2_64BIT_BAR_HIGH),
                upper_32_bits(adev->vcn.inst[inst_idx].gpu_addr + offset + AMDGPU_VCN_STACK_SIZE), 0, indirect);
        WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                VCN, 0, mmUVD_VCPU_CACHE_OFFSET2), 0, 0, indirect);
        WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                VCN, 0, mmUVD_VCPU_CACHE_SIZE2), AMDGPU_VCN_CONTEXT_SIZE, 0, indirect);

        /* non-cache window */
        WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                VCN, 0, mmUVD_LMI_VCPU_NC0_64BIT_BAR_LOW),
                lower_32_bits(adev->vcn.inst[inst_idx].fw_shared.gpu_addr), 0, indirect);
        WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                VCN, 0, mmUVD_LMI_VCPU_NC0_64BIT_BAR_HIGH),
                upper_32_bits(adev->vcn.inst[inst_idx].fw_shared.gpu_addr), 0, indirect);
        WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                VCN, 0, mmUVD_VCPU_NONCACHE_OFFSET0), 0, 0, indirect);
        WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                VCN, 0, mmUVD_VCPU_NONCACHE_SIZE0),
                AMDGPU_GPU_PAGE_ALIGN(sizeof(struct amdgpu_fw_shared)), 0, indirect);

        /* VCN global tiling registers */
        WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                VCN, 0, mmUVD_GFX8_ADDR_CONFIG), adev->gfx.config.gb_addr_config, 0, indirect);
}

/**
 * vcn_v2_5_disable_clock_gating - disable VCN clock gating
 *
 * @vinst: VCN instance
 *
 * Disable clock gating for VCN block
 */
static void vcn_v2_5_disable_clock_gating(struct amdgpu_vcn_inst *vinst)
{
        struct amdgpu_device *adev = vinst->adev;
        int i = vinst->inst;
        uint32_t data;

        if (adev->vcn.harvest_config & (1 << i))
                return;
        /* UVD disable CGC */
        data = RREG32_SOC15(VCN, i, mmUVD_CGC_CTRL);
        if (adev->cg_flags & AMD_CG_SUPPORT_VCN_MGCG)
                data |= 1 << UVD_CGC_CTRL__DYN_CLOCK_MODE__SHIFT;
        else
                data &= ~UVD_CGC_CTRL__DYN_CLOCK_MODE_MASK;
        data |= 1 << UVD_CGC_CTRL__CLK_GATE_DLY_TIMER__SHIFT;
        data |= 4 << UVD_CGC_CTRL__CLK_OFF_DELAY__SHIFT;
        WREG32_SOC15(VCN, i, mmUVD_CGC_CTRL, data);

        data = RREG32_SOC15(VCN, i, mmUVD_CGC_GATE);
        data &= ~(UVD_CGC_GATE__SYS_MASK
                  | UVD_CGC_GATE__UDEC_MASK
                  | UVD_CGC_GATE__MPEG2_MASK
                  | UVD_CGC_GATE__REGS_MASK
                  | UVD_CGC_GATE__RBC_MASK
                  | UVD_CGC_GATE__LMI_MC_MASK
                  | UVD_CGC_GATE__LMI_UMC_MASK
                  | UVD_CGC_GATE__IDCT_MASK
                  | UVD_CGC_GATE__MPRD_MASK
                  | UVD_CGC_GATE__MPC_MASK
                  | UVD_CGC_GATE__LBSI_MASK
                  | UVD_CGC_GATE__LRBBM_MASK
                  | UVD_CGC_GATE__UDEC_RE_MASK
                  | UVD_CGC_GATE__UDEC_CM_MASK
                  | UVD_CGC_GATE__UDEC_IT_MASK
                  | UVD_CGC_GATE__UDEC_DB_MASK
                  | UVD_CGC_GATE__UDEC_MP_MASK
                  | UVD_CGC_GATE__WCB_MASK
                  | UVD_CGC_GATE__VCPU_MASK
                  | UVD_CGC_GATE__MMSCH_MASK);

        WREG32_SOC15(VCN, i, mmUVD_CGC_GATE, data);

        SOC15_WAIT_ON_RREG(VCN, i, mmUVD_CGC_GATE, 0,  0xFFFFFFFF);

        data = RREG32_SOC15(VCN, i, mmUVD_CGC_CTRL);
        data &= ~(UVD_CGC_CTRL__UDEC_RE_MODE_MASK
                  | UVD_CGC_CTRL__UDEC_CM_MODE_MASK
                  | UVD_CGC_CTRL__UDEC_IT_MODE_MASK
                  | UVD_CGC_CTRL__UDEC_DB_MODE_MASK
                  | UVD_CGC_CTRL__UDEC_MP_MODE_MASK
                  | UVD_CGC_CTRL__SYS_MODE_MASK
                  | UVD_CGC_CTRL__UDEC_MODE_MASK
                  | UVD_CGC_CTRL__MPEG2_MODE_MASK
                  | UVD_CGC_CTRL__REGS_MODE_MASK
                  | UVD_CGC_CTRL__RBC_MODE_MASK
                  | UVD_CGC_CTRL__LMI_MC_MODE_MASK
                  | UVD_CGC_CTRL__LMI_UMC_MODE_MASK
                  | UVD_CGC_CTRL__IDCT_MODE_MASK
                  | UVD_CGC_CTRL__MPRD_MODE_MASK
                  | UVD_CGC_CTRL__MPC_MODE_MASK
                  | UVD_CGC_CTRL__LBSI_MODE_MASK
                  | UVD_CGC_CTRL__LRBBM_MODE_MASK
                  | UVD_CGC_CTRL__WCB_MODE_MASK
                  | UVD_CGC_CTRL__VCPU_MODE_MASK
                  | UVD_CGC_CTRL__MMSCH_MODE_MASK);
        WREG32_SOC15(VCN, i, mmUVD_CGC_CTRL, data);

        /* turn on */
        data = RREG32_SOC15(VCN, i, mmUVD_SUVD_CGC_GATE);
        data |= (UVD_SUVD_CGC_GATE__SRE_MASK
                 | UVD_SUVD_CGC_GATE__SIT_MASK
                 | UVD_SUVD_CGC_GATE__SMP_MASK
                 | UVD_SUVD_CGC_GATE__SCM_MASK
                 | UVD_SUVD_CGC_GATE__SDB_MASK
                 | UVD_SUVD_CGC_GATE__SRE_H264_MASK
                 | UVD_SUVD_CGC_GATE__SRE_HEVC_MASK
                 | UVD_SUVD_CGC_GATE__SIT_H264_MASK
                 | UVD_SUVD_CGC_GATE__SIT_HEVC_MASK
                 | UVD_SUVD_CGC_GATE__SCM_H264_MASK
                 | UVD_SUVD_CGC_GATE__SCM_HEVC_MASK
                 | UVD_SUVD_CGC_GATE__SDB_H264_MASK
                 | UVD_SUVD_CGC_GATE__SDB_HEVC_MASK
                 | UVD_SUVD_CGC_GATE__SCLR_MASK
                 | UVD_SUVD_CGC_GATE__UVD_SC_MASK
                 | UVD_SUVD_CGC_GATE__ENT_MASK
                 | UVD_SUVD_CGC_GATE__SIT_HEVC_DEC_MASK
                 | UVD_SUVD_CGC_GATE__SIT_HEVC_ENC_MASK
                 | UVD_SUVD_CGC_GATE__SITE_MASK
                 | UVD_SUVD_CGC_GATE__SRE_VP9_MASK
                 | UVD_SUVD_CGC_GATE__SCM_VP9_MASK
                 | UVD_SUVD_CGC_GATE__SIT_VP9_DEC_MASK
                 | UVD_SUVD_CGC_GATE__SDB_VP9_MASK
                 | UVD_SUVD_CGC_GATE__IME_HEVC_MASK);
        WREG32_SOC15(VCN, i, mmUVD_SUVD_CGC_GATE, data);

        data = RREG32_SOC15(VCN, i, mmUVD_SUVD_CGC_CTRL);
        data &= ~(UVD_SUVD_CGC_CTRL__SRE_MODE_MASK
                  | UVD_SUVD_CGC_CTRL__SIT_MODE_MASK
                  | UVD_SUVD_CGC_CTRL__SMP_MODE_MASK
                  | UVD_SUVD_CGC_CTRL__SCM_MODE_MASK
                  | UVD_SUVD_CGC_CTRL__SDB_MODE_MASK
                  | UVD_SUVD_CGC_CTRL__SCLR_MODE_MASK
                  | UVD_SUVD_CGC_CTRL__UVD_SC_MODE_MASK
                  | UVD_SUVD_CGC_CTRL__ENT_MODE_MASK
                        | UVD_SUVD_CGC_CTRL__IME_MODE_MASK
                  | UVD_SUVD_CGC_CTRL__SITE_MODE_MASK);
        WREG32_SOC15(VCN, i, mmUVD_SUVD_CGC_CTRL, data);
}

static void vcn_v2_5_clock_gating_dpg_mode(struct amdgpu_vcn_inst *vinst,
                uint8_t sram_sel, uint8_t indirect)
{
        struct amdgpu_device *adev = vinst->adev;
        int inst_idx = vinst->inst;
        uint32_t reg_data = 0;

        /* enable sw clock gating control */
        if (adev->cg_flags & AMD_CG_SUPPORT_VCN_MGCG)
                reg_data = 1 << UVD_CGC_CTRL__DYN_CLOCK_MODE__SHIFT;
        else
                reg_data = 0 << UVD_CGC_CTRL__DYN_CLOCK_MODE__SHIFT;
        reg_data |= 1 << UVD_CGC_CTRL__CLK_GATE_DLY_TIMER__SHIFT;
        reg_data |= 4 << UVD_CGC_CTRL__CLK_OFF_DELAY__SHIFT;
        reg_data &= ~(UVD_CGC_CTRL__UDEC_RE_MODE_MASK |
                 UVD_CGC_CTRL__UDEC_CM_MODE_MASK |
                 UVD_CGC_CTRL__UDEC_IT_MODE_MASK |
                 UVD_CGC_CTRL__UDEC_DB_MODE_MASK |
                 UVD_CGC_CTRL__UDEC_MP_MODE_MASK |
                 UVD_CGC_CTRL__SYS_MODE_MASK |
                 UVD_CGC_CTRL__UDEC_MODE_MASK |
                 UVD_CGC_CTRL__MPEG2_MODE_MASK |
                 UVD_CGC_CTRL__REGS_MODE_MASK |
                 UVD_CGC_CTRL__RBC_MODE_MASK |
                 UVD_CGC_CTRL__LMI_MC_MODE_MASK |
                 UVD_CGC_CTRL__LMI_UMC_MODE_MASK |
                 UVD_CGC_CTRL__IDCT_MODE_MASK |
                 UVD_CGC_CTRL__MPRD_MODE_MASK |
                 UVD_CGC_CTRL__MPC_MODE_MASK |
                 UVD_CGC_CTRL__LBSI_MODE_MASK |
                 UVD_CGC_CTRL__LRBBM_MODE_MASK |
                 UVD_CGC_CTRL__WCB_MODE_MASK |
                 UVD_CGC_CTRL__VCPU_MODE_MASK |
                 UVD_CGC_CTRL__MMSCH_MODE_MASK);
        WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                VCN, 0, mmUVD_CGC_CTRL), reg_data, sram_sel, indirect);

        /* turn off clock gating */
        WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                VCN, 0, mmUVD_CGC_GATE), 0, sram_sel, indirect);

        /* turn on SUVD clock gating */
        WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                VCN, 0, mmUVD_SUVD_CGC_GATE), 1, sram_sel, indirect);

        /* turn on sw mode in UVD_SUVD_CGC_CTRL */
        WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                VCN, 0, mmUVD_SUVD_CGC_CTRL), 0, sram_sel, indirect);
}

/**
 * vcn_v2_5_enable_clock_gating - enable VCN clock gating
 *
 * @vinst: VCN instance
 *
 * Enable clock gating for VCN block
 */
static void vcn_v2_5_enable_clock_gating(struct amdgpu_vcn_inst *vinst)
{
        struct amdgpu_device *adev = vinst->adev;
        int i = vinst->inst;
        uint32_t data = 0;

        if (adev->vcn.harvest_config & (1 << i))
                return;
        /* enable UVD CGC */
        data = RREG32_SOC15(VCN, i, mmUVD_CGC_CTRL);
        if (adev->cg_flags & AMD_CG_SUPPORT_VCN_MGCG)
                data |= 1 << UVD_CGC_CTRL__DYN_CLOCK_MODE__SHIFT;
        else
                data |= 0 << UVD_CGC_CTRL__DYN_CLOCK_MODE__SHIFT;
        data |= 1 << UVD_CGC_CTRL__CLK_GATE_DLY_TIMER__SHIFT;
        data |= 4 << UVD_CGC_CTRL__CLK_OFF_DELAY__SHIFT;
        WREG32_SOC15(VCN, i, mmUVD_CGC_CTRL, data);

        data = RREG32_SOC15(VCN, i, mmUVD_CGC_CTRL);
        data |= (UVD_CGC_CTRL__UDEC_RE_MODE_MASK
                 | UVD_CGC_CTRL__UDEC_CM_MODE_MASK
                 | UVD_CGC_CTRL__UDEC_IT_MODE_MASK
                 | UVD_CGC_CTRL__UDEC_DB_MODE_MASK
                 | UVD_CGC_CTRL__UDEC_MP_MODE_MASK
                 | UVD_CGC_CTRL__SYS_MODE_MASK
                 | UVD_CGC_CTRL__UDEC_MODE_MASK
                 | UVD_CGC_CTRL__MPEG2_MODE_MASK
                 | UVD_CGC_CTRL__REGS_MODE_MASK
                 | UVD_CGC_CTRL__RBC_MODE_MASK
                 | UVD_CGC_CTRL__LMI_MC_MODE_MASK
                 | UVD_CGC_CTRL__LMI_UMC_MODE_MASK
                 | UVD_CGC_CTRL__IDCT_MODE_MASK
                 | UVD_CGC_CTRL__MPRD_MODE_MASK
                 | UVD_CGC_CTRL__MPC_MODE_MASK
                 | UVD_CGC_CTRL__LBSI_MODE_MASK
                 | UVD_CGC_CTRL__LRBBM_MODE_MASK
                 | UVD_CGC_CTRL__WCB_MODE_MASK
                 | UVD_CGC_CTRL__VCPU_MODE_MASK);
        WREG32_SOC15(VCN, i, mmUVD_CGC_CTRL, data);

        data = RREG32_SOC15(VCN, i, mmUVD_SUVD_CGC_CTRL);
        data |= (UVD_SUVD_CGC_CTRL__SRE_MODE_MASK
                 | UVD_SUVD_CGC_CTRL__SIT_MODE_MASK
                 | UVD_SUVD_CGC_CTRL__SMP_MODE_MASK
                 | UVD_SUVD_CGC_CTRL__SCM_MODE_MASK
                 | UVD_SUVD_CGC_CTRL__SDB_MODE_MASK
                 | UVD_SUVD_CGC_CTRL__SCLR_MODE_MASK
                 | UVD_SUVD_CGC_CTRL__UVD_SC_MODE_MASK
                 | UVD_SUVD_CGC_CTRL__ENT_MODE_MASK
                 | UVD_SUVD_CGC_CTRL__IME_MODE_MASK
                 | UVD_SUVD_CGC_CTRL__SITE_MODE_MASK);
        WREG32_SOC15(VCN, i, mmUVD_SUVD_CGC_CTRL, data);
}

static void vcn_v2_6_enable_ras(struct amdgpu_vcn_inst *vinst,
                                bool indirect)
{
        struct amdgpu_device *adev = vinst->adev;
        int inst_idx = vinst->inst;
        uint32_t tmp;

        if (amdgpu_ip_version(adev, UVD_HWIP, 0) != IP_VERSION(2, 6, 0))
                return;

        tmp = VCN_RAS_CNTL__VCPU_VCODEC_REARM_MASK |
              VCN_RAS_CNTL__VCPU_VCODEC_IH_EN_MASK |
              VCN_RAS_CNTL__VCPU_VCODEC_PMI_EN_MASK |
              VCN_RAS_CNTL__VCPU_VCODEC_STALL_EN_MASK;
        WREG32_SOC15_DPG_MODE(inst_idx,
                              SOC15_DPG_MODE_OFFSET(VCN, 0, mmVCN_RAS_CNTL),
                              tmp, 0, indirect);

        tmp = UVD_VCPU_INT_EN__RASCNTL_VCPU_VCODEC_EN_MASK;
        WREG32_SOC15_DPG_MODE(inst_idx,
                              SOC15_DPG_MODE_OFFSET(VCN, 0, mmUVD_VCPU_INT_EN),
                              tmp, 0, indirect);

        tmp = UVD_SYS_INT_EN__RASCNTL_VCPU_VCODEC_EN_MASK;
        WREG32_SOC15_DPG_MODE(inst_idx,
                              SOC15_DPG_MODE_OFFSET(VCN, 0, mmUVD_SYS_INT_EN),
                              tmp, 0, indirect);
}

static int vcn_v2_5_start_dpg_mode(struct amdgpu_vcn_inst *vinst, bool indirect)
{
        struct amdgpu_device *adev = vinst->adev;
        int inst_idx = vinst->inst;
        struct amdgpu_fw_shared *fw_shared = adev->vcn.inst[inst_idx].fw_shared.cpu_addr;
        struct amdgpu_ring *ring;
        uint32_t rb_bufsz, tmp;
        int ret;

        /* disable register anti-hang mechanism */
        WREG32_P(SOC15_REG_OFFSET(VCN, inst_idx, mmUVD_POWER_STATUS), 1,
                ~UVD_POWER_STATUS__UVD_POWER_STATUS_MASK);
        /* enable dynamic power gating mode */
        tmp = RREG32_SOC15(VCN, inst_idx, mmUVD_POWER_STATUS);
        tmp |= UVD_POWER_STATUS__UVD_PG_MODE_MASK;
        tmp |= UVD_POWER_STATUS__UVD_PG_EN_MASK;
        WREG32_SOC15(VCN, inst_idx, mmUVD_POWER_STATUS, tmp);

        if (indirect)
                adev->vcn.inst[inst_idx].dpg_sram_curr_addr = (uint32_t *)adev->vcn.inst[inst_idx].dpg_sram_cpu_addr;

        /* enable clock gating */
        vcn_v2_5_clock_gating_dpg_mode(vinst, 0, indirect);

        /* enable VCPU clock */
        tmp = (0xFF << UVD_VCPU_CNTL__PRB_TIMEOUT_VAL__SHIFT);
        tmp |= UVD_VCPU_CNTL__CLK_EN_MASK;
        tmp |= UVD_VCPU_CNTL__BLK_RST_MASK;
        WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                VCN, 0, mmUVD_VCPU_CNTL), tmp, 0, indirect);

        /* disable master interupt */
        WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                VCN, 0, mmUVD_MASTINT_EN), 0, 0, indirect);

        /* setup mmUVD_LMI_CTRL */
        tmp = (0x8 | UVD_LMI_CTRL__WRITE_CLEAN_TIMER_EN_MASK |
                UVD_LMI_CTRL__REQ_MODE_MASK |
                UVD_LMI_CTRL__CRC_RESET_MASK |
                UVD_LMI_CTRL__MASK_MC_URGENT_MASK |
                UVD_LMI_CTRL__DATA_COHERENCY_EN_MASK |
                UVD_LMI_CTRL__VCPU_DATA_COHERENCY_EN_MASK |
                (8 << UVD_LMI_CTRL__WRITE_CLEAN_TIMER__SHIFT) |
                0x00100000L);
        WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                VCN, 0, mmUVD_LMI_CTRL), tmp, 0, indirect);

        WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                VCN, 0, mmUVD_MPC_CNTL),
                0x2 << UVD_MPC_CNTL__REPLACEMENT_MODE__SHIFT, 0, indirect);

        WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                VCN, 0, mmUVD_MPC_SET_MUXA0),
                ((0x1 << UVD_MPC_SET_MUXA0__VARA_1__SHIFT) |
                 (0x2 << UVD_MPC_SET_MUXA0__VARA_2__SHIFT) |
                 (0x3 << UVD_MPC_SET_MUXA0__VARA_3__SHIFT) |
                 (0x4 << UVD_MPC_SET_MUXA0__VARA_4__SHIFT)), 0, indirect);

        WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                VCN, 0, mmUVD_MPC_SET_MUXB0),
                ((0x1 << UVD_MPC_SET_MUXB0__VARB_1__SHIFT) |
                 (0x2 << UVD_MPC_SET_MUXB0__VARB_2__SHIFT) |
                 (0x3 << UVD_MPC_SET_MUXB0__VARB_3__SHIFT) |
                 (0x4 << UVD_MPC_SET_MUXB0__VARB_4__SHIFT)), 0, indirect);

        WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                VCN, 0, mmUVD_MPC_SET_MUX),
                ((0x0 << UVD_MPC_SET_MUX__SET_0__SHIFT) |
                 (0x1 << UVD_MPC_SET_MUX__SET_1__SHIFT) |
                 (0x2 << UVD_MPC_SET_MUX__SET_2__SHIFT)), 0, indirect);

        vcn_v2_5_mc_resume_dpg_mode(vinst, indirect);

        WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                VCN, 0, mmUVD_REG_XX_MASK), 0x10, 0, indirect);
        WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                VCN, 0, mmUVD_RBC_XX_IB_REG_CHECK), 0x3, 0, indirect);

        /* enable LMI MC and UMC channels */
        WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                VCN, 0, mmUVD_LMI_CTRL2), 0, 0, indirect);

        vcn_v2_6_enable_ras(vinst, indirect);

        /* unblock VCPU register access */
        WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                VCN, 0, mmUVD_RB_ARB_CTRL), 0, 0, indirect);

        tmp = (0xFF << UVD_VCPU_CNTL__PRB_TIMEOUT_VAL__SHIFT);
        tmp |= UVD_VCPU_CNTL__CLK_EN_MASK;
        WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                VCN, 0, mmUVD_VCPU_CNTL), tmp, 0, indirect);

        /* enable master interrupt */
        WREG32_SOC15_DPG_MODE(inst_idx, SOC15_DPG_MODE_OFFSET(
                VCN, 0, mmUVD_MASTINT_EN),
                UVD_MASTINT_EN__VCPU_EN_MASK, 0, indirect);

        if (indirect) {
                ret = amdgpu_vcn_psp_update_sram(adev, inst_idx, 0);
                if (ret) {
                        dev_err(adev->dev, "vcn sram load failed %d\n", ret);
                        return ret;
                }
        }

        ring = &adev->vcn.inst[inst_idx].ring_dec;
        /* force RBC into idle state */
        rb_bufsz = order_base_2(ring->ring_size);
        tmp = REG_SET_FIELD(0, UVD_RBC_RB_CNTL, RB_BUFSZ, rb_bufsz);
        tmp = REG_SET_FIELD(tmp, UVD_RBC_RB_CNTL, RB_BLKSZ, 1);
        tmp = REG_SET_FIELD(tmp, UVD_RBC_RB_CNTL, RB_NO_FETCH, 1);
        tmp = REG_SET_FIELD(tmp, UVD_RBC_RB_CNTL, RB_NO_UPDATE, 1);
        tmp = REG_SET_FIELD(tmp, UVD_RBC_RB_CNTL, RB_RPTR_WR_EN, 1);
        WREG32_SOC15(VCN, inst_idx, mmUVD_RBC_RB_CNTL, tmp);

        /* Stall DPG before WPTR/RPTR reset */
        WREG32_P(SOC15_REG_OFFSET(VCN, inst_idx, mmUVD_POWER_STATUS),
                UVD_POWER_STATUS__STALL_DPG_POWER_UP_MASK,
                ~UVD_POWER_STATUS__STALL_DPG_POWER_UP_MASK);
        fw_shared->multi_queue.decode_queue_mode |= FW_QUEUE_RING_RESET;

        /* set the write pointer delay */
        WREG32_SOC15(VCN, inst_idx, mmUVD_RBC_RB_WPTR_CNTL, 0);

        /* set the wb address */
        WREG32_SOC15(VCN, inst_idx, mmUVD_RBC_RB_RPTR_ADDR,
                (upper_32_bits(ring->gpu_addr) >> 2));

        /* program the RB_BASE for ring buffer */
        WREG32_SOC15(VCN, inst_idx, mmUVD_LMI_RBC_RB_64BIT_BAR_LOW,
                lower_32_bits(ring->gpu_addr));
        WREG32_SOC15(VCN, inst_idx, mmUVD_LMI_RBC_RB_64BIT_BAR_HIGH,
                upper_32_bits(ring->gpu_addr));

        /* Initialize the ring buffer's read and write pointers */
        WREG32_SOC15(VCN, inst_idx, mmUVD_RBC_RB_RPTR, 0);

        WREG32_SOC15(VCN, inst_idx, mmUVD_SCRATCH2, 0);

        ring->wptr = RREG32_SOC15(VCN, inst_idx, mmUVD_RBC_RB_RPTR);
        WREG32_SOC15(VCN, inst_idx, mmUVD_RBC_RB_WPTR,
                lower_32_bits(ring->wptr));

        fw_shared->multi_queue.decode_queue_mode &= ~FW_QUEUE_RING_RESET;
        /* Unstall DPG */
        WREG32_P(SOC15_REG_OFFSET(VCN, inst_idx, mmUVD_POWER_STATUS),
                0, ~UVD_POWER_STATUS__STALL_DPG_POWER_UP_MASK);

        /* Keeping one read-back to ensure all register writes are done,
         * otherwise it may introduce race conditions.
         */
        RREG32_SOC15(VCN, inst_idx, mmUVD_STATUS);

        return 0;
}

static int vcn_v2_5_start(struct amdgpu_vcn_inst *vinst)
{
        struct amdgpu_device *adev = vinst->adev;
        int i = vinst->inst;
        struct amdgpu_fw_shared *fw_shared =
                adev->vcn.inst[i].fw_shared.cpu_addr;
        struct amdgpu_ring *ring;
        uint32_t rb_bufsz, tmp;
        int j, k, r;

        if (adev->vcn.harvest_config & (1 << i))
                return 0;

        if (adev->pm.dpm_enabled)
                amdgpu_dpm_enable_vcn(adev, true, i);

        if (adev->pg_flags & AMD_PG_SUPPORT_VCN_DPG)
                return vcn_v2_5_start_dpg_mode(vinst, adev->vcn.inst[i].indirect_sram);

        /* disable register anti-hang mechanism */
        WREG32_P(SOC15_REG_OFFSET(VCN, i, mmUVD_POWER_STATUS), 0,
                 ~UVD_POWER_STATUS__UVD_POWER_STATUS_MASK);

        /* set uvd status busy */
        tmp = RREG32_SOC15(VCN, i, mmUVD_STATUS) | UVD_STATUS__UVD_BUSY;
        WREG32_SOC15(VCN, i, mmUVD_STATUS, tmp);

        if (adev->pg_flags & AMD_PG_SUPPORT_VCN_DPG)
                return 0;

        /* SW clock gating */
        vcn_v2_5_disable_clock_gating(vinst);

        /* enable VCPU clock */
        WREG32_P(SOC15_REG_OFFSET(VCN, i, mmUVD_VCPU_CNTL),
                 UVD_VCPU_CNTL__CLK_EN_MASK, ~UVD_VCPU_CNTL__CLK_EN_MASK);

        /* disable master interrupt */
        WREG32_P(SOC15_REG_OFFSET(VCN, i, mmUVD_MASTINT_EN), 0,
                 ~UVD_MASTINT_EN__VCPU_EN_MASK);

        /* setup mmUVD_LMI_CTRL */
        tmp = RREG32_SOC15(VCN, i, mmUVD_LMI_CTRL);
        tmp &= ~0xff;
        WREG32_SOC15(VCN, i, mmUVD_LMI_CTRL, tmp | 0x8|
                     UVD_LMI_CTRL__WRITE_CLEAN_TIMER_EN_MASK    |
                     UVD_LMI_CTRL__MASK_MC_URGENT_MASK |
                     UVD_LMI_CTRL__DATA_COHERENCY_EN_MASK |
                     UVD_LMI_CTRL__VCPU_DATA_COHERENCY_EN_MASK);

        /* setup mmUVD_MPC_CNTL */
        tmp = RREG32_SOC15(VCN, i, mmUVD_MPC_CNTL);
        tmp &= ~UVD_MPC_CNTL__REPLACEMENT_MODE_MASK;
        tmp |= 0x2 << UVD_MPC_CNTL__REPLACEMENT_MODE__SHIFT;
        WREG32_SOC15(VCN, i, mmUVD_MPC_CNTL, tmp);

        /* setup UVD_MPC_SET_MUXA0 */
        WREG32_SOC15(VCN, i, mmUVD_MPC_SET_MUXA0,
                     ((0x1 << UVD_MPC_SET_MUXA0__VARA_1__SHIFT) |
                      (0x2 << UVD_MPC_SET_MUXA0__VARA_2__SHIFT) |
                      (0x3 << UVD_MPC_SET_MUXA0__VARA_3__SHIFT) |
                      (0x4 << UVD_MPC_SET_MUXA0__VARA_4__SHIFT)));

        /* setup UVD_MPC_SET_MUXB0 */
        WREG32_SOC15(VCN, i, mmUVD_MPC_SET_MUXB0,
                     ((0x1 << UVD_MPC_SET_MUXB0__VARB_1__SHIFT) |
                      (0x2 << UVD_MPC_SET_MUXB0__VARB_2__SHIFT) |
                      (0x3 << UVD_MPC_SET_MUXB0__VARB_3__SHIFT) |
                      (0x4 << UVD_MPC_SET_MUXB0__VARB_4__SHIFT)));

        /* setup mmUVD_MPC_SET_MUX */
        WREG32_SOC15(VCN, i, mmUVD_MPC_SET_MUX,
                     ((0x0 << UVD_MPC_SET_MUX__SET_0__SHIFT) |
                      (0x1 << UVD_MPC_SET_MUX__SET_1__SHIFT) |
                      (0x2 << UVD_MPC_SET_MUX__SET_2__SHIFT)));

        vcn_v2_5_mc_resume(vinst);

        /* VCN global tiling registers */
        WREG32_SOC15(VCN, i, mmUVD_GFX8_ADDR_CONFIG,
                     adev->gfx.config.gb_addr_config);
        WREG32_SOC15(VCN, i, mmUVD_GFX8_ADDR_CONFIG,
                     adev->gfx.config.gb_addr_config);

        /* enable LMI MC and UMC channels */
        WREG32_P(SOC15_REG_OFFSET(VCN, i, mmUVD_LMI_CTRL2), 0,
                 ~UVD_LMI_CTRL2__STALL_ARB_UMC_MASK);

        /* unblock VCPU register access */
        WREG32_P(SOC15_REG_OFFSET(VCN, i, mmUVD_RB_ARB_CTRL), 0,
                 ~UVD_RB_ARB_CTRL__VCPU_DIS_MASK);

        WREG32_P(SOC15_REG_OFFSET(VCN, i, mmUVD_VCPU_CNTL), 0,
                 ~UVD_VCPU_CNTL__BLK_RST_MASK);

        for (k = 0; k < 10; ++k) {
                uint32_t status;

                for (j = 0; j < 100; ++j) {
                        status = RREG32_SOC15(VCN, i, mmUVD_STATUS);
                        if (status & 2)
                                break;
                        if (amdgpu_emu_mode == 1)
                                msleep(500);
                        else
                                mdelay(10);
                }
                r = 0;
                if (status & 2)
                        break;

                DRM_ERROR("VCN decode not responding, trying to reset the VCPU!!!\n");
                WREG32_P(SOC15_REG_OFFSET(VCN, i, mmUVD_VCPU_CNTL),
                         UVD_VCPU_CNTL__BLK_RST_MASK,
                         ~UVD_VCPU_CNTL__BLK_RST_MASK);
                mdelay(10);
                WREG32_P(SOC15_REG_OFFSET(VCN, i, mmUVD_VCPU_CNTL), 0,
                         ~UVD_VCPU_CNTL__BLK_RST_MASK);

                mdelay(10);
                r = -1;
        }

        if (r) {
                DRM_ERROR("VCN decode not responding, giving up!!!\n");
                return r;
        }

        /* enable master interrupt */
        WREG32_P(SOC15_REG_OFFSET(VCN, i, mmUVD_MASTINT_EN),
                 UVD_MASTINT_EN__VCPU_EN_MASK,
                 ~UVD_MASTINT_EN__VCPU_EN_MASK);

        /* clear the busy bit of VCN_STATUS */
        WREG32_P(SOC15_REG_OFFSET(VCN, i, mmUVD_STATUS), 0,
                 ~(2 << UVD_STATUS__VCPU_REPORT__SHIFT));

        WREG32_SOC15(VCN, i, mmUVD_LMI_RBC_RB_VMID, 0);

        ring = &adev->vcn.inst[i].ring_dec;
        /* force RBC into idle state */
        rb_bufsz = order_base_2(ring->ring_size);
        tmp = REG_SET_FIELD(0, UVD_RBC_RB_CNTL, RB_BUFSZ, rb_bufsz);
        tmp = REG_SET_FIELD(tmp, UVD_RBC_RB_CNTL, RB_BLKSZ, 1);
        tmp = REG_SET_FIELD(tmp, UVD_RBC_RB_CNTL, RB_NO_FETCH, 1);
        tmp = REG_SET_FIELD(tmp, UVD_RBC_RB_CNTL, RB_NO_UPDATE, 1);
        tmp = REG_SET_FIELD(tmp, UVD_RBC_RB_CNTL, RB_RPTR_WR_EN, 1);
        WREG32_SOC15(VCN, i, mmUVD_RBC_RB_CNTL, tmp);

        fw_shared->multi_queue.decode_queue_mode |= FW_QUEUE_RING_RESET;
        /* program the RB_BASE for ring buffer */
        WREG32_SOC15(VCN, i, mmUVD_LMI_RBC_RB_64BIT_BAR_LOW,
                     lower_32_bits(ring->gpu_addr));
        WREG32_SOC15(VCN, i, mmUVD_LMI_RBC_RB_64BIT_BAR_HIGH,
                     upper_32_bits(ring->gpu_addr));

        /* Initialize the ring buffer's read and write pointers */
        WREG32_SOC15(VCN, i, mmUVD_RBC_RB_RPTR, 0);

        ring->wptr = RREG32_SOC15(VCN, i, mmUVD_RBC_RB_RPTR);
        WREG32_SOC15(VCN, i, mmUVD_RBC_RB_WPTR,
                     lower_32_bits(ring->wptr));
        fw_shared->multi_queue.decode_queue_mode &= ~FW_QUEUE_RING_RESET;

        fw_shared->multi_queue.encode_generalpurpose_queue_mode |= FW_QUEUE_RING_RESET;
        ring = &adev->vcn.inst[i].ring_enc[0];
        WREG32_SOC15(VCN, i, mmUVD_RB_RPTR, lower_32_bits(ring->wptr));
        WREG32_SOC15(VCN, i, mmUVD_RB_WPTR, lower_32_bits(ring->wptr));
        WREG32_SOC15(VCN, i, mmUVD_RB_BASE_LO, ring->gpu_addr);
        WREG32_SOC15(VCN, i, mmUVD_RB_BASE_HI, upper_32_bits(ring->gpu_addr));
        WREG32_SOC15(VCN, i, mmUVD_RB_SIZE, ring->ring_size / 4);
        fw_shared->multi_queue.encode_generalpurpose_queue_mode &= ~FW_QUEUE_RING_RESET;

        fw_shared->multi_queue.encode_lowlatency_queue_mode |= FW_QUEUE_RING_RESET;
        ring = &adev->vcn.inst[i].ring_enc[1];
        WREG32_SOC15(VCN, i, mmUVD_RB_RPTR2, lower_32_bits(ring->wptr));
        WREG32_SOC15(VCN, i, mmUVD_RB_WPTR2, lower_32_bits(ring->wptr));
        WREG32_SOC15(VCN, i, mmUVD_RB_BASE_LO2, ring->gpu_addr);
        WREG32_SOC15(VCN, i, mmUVD_RB_BASE_HI2, upper_32_bits(ring->gpu_addr));
        WREG32_SOC15(VCN, i, mmUVD_RB_SIZE2, ring->ring_size / 4);
        fw_shared->multi_queue.encode_lowlatency_queue_mode &= ~FW_QUEUE_RING_RESET;

        /* Keeping one read-back to ensure all register writes are done,
         * otherwise it may introduce race conditions.
         */
        RREG32_SOC15(VCN, i, mmUVD_STATUS);

        return 0;
}

static int vcn_v2_5_mmsch_start(struct amdgpu_device *adev,
                                struct amdgpu_mm_table *table)
{
        uint32_t data = 0, loop = 0, size = 0;
        uint64_t addr = table->gpu_addr;
        struct mmsch_v1_1_init_header *header = NULL;

        header = (struct mmsch_v1_1_init_header *)table->cpu_addr;
        size = header->total_size;

        /*
         * 1, write to vce_mmsch_vf_ctx_addr_lo/hi register with GPU mc addr of
         *  memory descriptor location
         */
        WREG32_SOC15(VCN, 0, mmMMSCH_VF_CTX_ADDR_LO, lower_32_bits(addr));
        WREG32_SOC15(VCN, 0, mmMMSCH_VF_CTX_ADDR_HI, upper_32_bits(addr));

        /* 2, update vmid of descriptor */
        data = RREG32_SOC15(VCN, 0, mmMMSCH_VF_VMID);
        data &= ~MMSCH_VF_VMID__VF_CTX_VMID_MASK;
        /* use domain0 for MM scheduler */
        data |= (0 << MMSCH_VF_VMID__VF_CTX_VMID__SHIFT);
        WREG32_SOC15(VCN, 0, mmMMSCH_VF_VMID, data);

        /* 3, notify mmsch about the size of this descriptor */
        WREG32_SOC15(VCN, 0, mmMMSCH_VF_CTX_SIZE, size);

        /* 4, set resp to zero */
        WREG32_SOC15(VCN, 0, mmMMSCH_VF_MAILBOX_RESP, 0);

        /*
         * 5, kick off the initialization and wait until
         * VCE_MMSCH_VF_MAILBOX_RESP becomes non-zero
         */
        WREG32_SOC15(VCN, 0, mmMMSCH_VF_MAILBOX_HOST, 0x10000001);

        data = RREG32_SOC15(VCN, 0, mmMMSCH_VF_MAILBOX_RESP);
        loop = 10;
        while ((data & 0x10000002) != 0x10000002) {
                udelay(100);
                data = RREG32_SOC15(VCN, 0, mmMMSCH_VF_MAILBOX_RESP);
                loop--;
                if (!loop)
                        break;
        }

        if (!loop) {
                dev_err(adev->dev,
                        "failed to init MMSCH, mmMMSCH_VF_MAILBOX_RESP = %x\n",
                        data);
                return -EBUSY;
        }

        return 0;
}

static int vcn_v2_5_sriov_start(struct amdgpu_device *adev)
{
        struct amdgpu_ring *ring;
        uint32_t offset, size, tmp, i, rb_bufsz;
        uint32_t table_size = 0;
        struct mmsch_v1_0_cmd_direct_write direct_wt = { { 0 } };
        struct mmsch_v1_0_cmd_direct_read_modify_write direct_rd_mod_wt = { { 0 } };
        struct mmsch_v1_0_cmd_end end = { { 0 } };
        uint32_t *init_table = adev->virt.mm_table.cpu_addr;
        struct mmsch_v1_1_init_header *header = (struct mmsch_v1_1_init_header *)init_table;

        direct_wt.cmd_header.command_type = MMSCH_COMMAND__DIRECT_REG_WRITE;
        direct_rd_mod_wt.cmd_header.command_type = MMSCH_COMMAND__DIRECT_REG_READ_MODIFY_WRITE;
        end.cmd_header.command_type = MMSCH_COMMAND__END;

        header->version = MMSCH_VERSION;
        header->total_size = sizeof(struct mmsch_v1_1_init_header) >> 2;
        init_table += header->total_size;

        for (i = 0; i < adev->vcn.num_vcn_inst; ++i) {
                header->eng[i].table_offset = header->total_size;
                header->eng[i].init_status = 0;
                header->eng[i].table_size = 0;

                table_size = 0;

                MMSCH_V1_0_INSERT_DIRECT_RD_MOD_WT(
                        SOC15_REG_OFFSET(VCN, i, mmUVD_STATUS),
                        ~UVD_STATUS__UVD_BUSY, UVD_STATUS__UVD_BUSY);

                size = AMDGPU_GPU_PAGE_ALIGN(adev->vcn.inst[i].fw->size + 4);
                /* mc resume*/
                if (adev->firmware.load_type == AMDGPU_FW_LOAD_PSP) {
                        MMSCH_V1_0_INSERT_DIRECT_WT(
                                SOC15_REG_OFFSET(VCN, i,
                                        mmUVD_LMI_VCPU_CACHE_64BIT_BAR_LOW),
                                adev->firmware.ucode[AMDGPU_UCODE_ID_VCN + i].tmr_mc_addr_lo);
                        MMSCH_V1_0_INSERT_DIRECT_WT(
                                SOC15_REG_OFFSET(VCN, i,
                                        mmUVD_LMI_VCPU_CACHE_64BIT_BAR_HIGH),
                                adev->firmware.ucode[AMDGPU_UCODE_ID_VCN + i].tmr_mc_addr_hi);
                        offset = 0;
                        MMSCH_V1_0_INSERT_DIRECT_WT(
                                SOC15_REG_OFFSET(VCN, i, mmUVD_VCPU_CACHE_OFFSET0), 0);
                } else {
                        MMSCH_V1_0_INSERT_DIRECT_WT(
                                SOC15_REG_OFFSET(VCN, i,
                                        mmUVD_LMI_VCPU_CACHE_64BIT_BAR_LOW),
                                lower_32_bits(adev->vcn.inst[i].gpu_addr));
                        MMSCH_V1_0_INSERT_DIRECT_WT(
                                SOC15_REG_OFFSET(VCN, i,
                                        mmUVD_LMI_VCPU_CACHE_64BIT_BAR_HIGH),
                                upper_32_bits(adev->vcn.inst[i].gpu_addr));
                        offset = size;
                        MMSCH_V1_0_INSERT_DIRECT_WT(
                                SOC15_REG_OFFSET(VCN, i, mmUVD_VCPU_CACHE_OFFSET0),
                                AMDGPU_UVD_FIRMWARE_OFFSET >> 3);
                }

                MMSCH_V1_0_INSERT_DIRECT_WT(
                        SOC15_REG_OFFSET(VCN, i, mmUVD_VCPU_CACHE_SIZE0),
                        size);
                MMSCH_V1_0_INSERT_DIRECT_WT(
                        SOC15_REG_OFFSET(VCN, i,
                                mmUVD_LMI_VCPU_CACHE1_64BIT_BAR_LOW),
                        lower_32_bits(adev->vcn.inst[i].gpu_addr + offset));
                MMSCH_V1_0_INSERT_DIRECT_WT(
                        SOC15_REG_OFFSET(VCN, i,
                                mmUVD_LMI_VCPU_CACHE1_64BIT_BAR_HIGH),
                        upper_32_bits(adev->vcn.inst[i].gpu_addr + offset));
                MMSCH_V1_0_INSERT_DIRECT_WT(
                        SOC15_REG_OFFSET(VCN, i, mmUVD_VCPU_CACHE_OFFSET1),
                        0);
                MMSCH_V1_0_INSERT_DIRECT_WT(
                        SOC15_REG_OFFSET(VCN, i, mmUVD_VCPU_CACHE_SIZE1),
                        AMDGPU_VCN_STACK_SIZE);
                MMSCH_V1_0_INSERT_DIRECT_WT(
                        SOC15_REG_OFFSET(VCN, i,
                                mmUVD_LMI_VCPU_CACHE2_64BIT_BAR_LOW),
                        lower_32_bits(adev->vcn.inst[i].gpu_addr + offset +
                                AMDGPU_VCN_STACK_SIZE));
                MMSCH_V1_0_INSERT_DIRECT_WT(
                        SOC15_REG_OFFSET(VCN, i,
                                mmUVD_LMI_VCPU_CACHE2_64BIT_BAR_HIGH),
                        upper_32_bits(adev->vcn.inst[i].gpu_addr + offset +
                                AMDGPU_VCN_STACK_SIZE));
                MMSCH_V1_0_INSERT_DIRECT_WT(
                        SOC15_REG_OFFSET(VCN, i, mmUVD_VCPU_CACHE_OFFSET2),
                        0);
                MMSCH_V1_0_INSERT_DIRECT_WT(
                        SOC15_REG_OFFSET(VCN, i, mmUVD_VCPU_CACHE_SIZE2),
                        AMDGPU_VCN_CONTEXT_SIZE);

                ring = &adev->vcn.inst[i].ring_enc[0];
                ring->wptr = 0;

                MMSCH_V1_0_INSERT_DIRECT_WT(
                        SOC15_REG_OFFSET(VCN, i, mmUVD_RB_BASE_LO),
                        lower_32_bits(ring->gpu_addr));
                MMSCH_V1_0_INSERT_DIRECT_WT(
                        SOC15_REG_OFFSET(VCN, i, mmUVD_RB_BASE_HI),
                        upper_32_bits(ring->gpu_addr));
                MMSCH_V1_0_INSERT_DIRECT_WT(
                        SOC15_REG_OFFSET(VCN, i, mmUVD_RB_SIZE),
                        ring->ring_size / 4);

                ring = &adev->vcn.inst[i].ring_dec;
                ring->wptr = 0;
                MMSCH_V1_0_INSERT_DIRECT_WT(
                        SOC15_REG_OFFSET(VCN, i,
                                mmUVD_LMI_RBC_RB_64BIT_BAR_LOW),
                        lower_32_bits(ring->gpu_addr));
                MMSCH_V1_0_INSERT_DIRECT_WT(
                        SOC15_REG_OFFSET(VCN, i,
                                mmUVD_LMI_RBC_RB_64BIT_BAR_HIGH),
                        upper_32_bits(ring->gpu_addr));

                /* force RBC into idle state */
                rb_bufsz = order_base_2(ring->ring_size);
                tmp = REG_SET_FIELD(0, UVD_RBC_RB_CNTL, RB_BUFSZ, rb_bufsz);
                tmp = REG_SET_FIELD(tmp, UVD_RBC_RB_CNTL, RB_BLKSZ, 1);
                tmp = REG_SET_FIELD(tmp, UVD_RBC_RB_CNTL, RB_NO_FETCH, 1);
                tmp = REG_SET_FIELD(tmp, UVD_RBC_RB_CNTL, RB_NO_UPDATE, 1);
                tmp = REG_SET_FIELD(tmp, UVD_RBC_RB_CNTL, RB_RPTR_WR_EN, 1);
                MMSCH_V1_0_INSERT_DIRECT_WT(
                        SOC15_REG_OFFSET(VCN, i, mmUVD_RBC_RB_CNTL), tmp);

                /* add end packet */
                memcpy((void *)init_table, &end, sizeof(struct mmsch_v1_0_cmd_end));
                table_size += sizeof(struct mmsch_v1_0_cmd_end) / 4;
                init_table += sizeof(struct mmsch_v1_0_cmd_end) / 4;

                /* refine header */
                header->eng[i].table_size = table_size;
                header->total_size += table_size;
        }

        return vcn_v2_5_mmsch_start(adev, &adev->virt.mm_table);
}

static int vcn_v2_5_stop_dpg_mode(struct amdgpu_vcn_inst *vinst)
{
        struct amdgpu_device *adev = vinst->adev;
        int inst_idx = vinst->inst;
        uint32_t tmp;

        /* Wait for power status to be 1 */
        SOC15_WAIT_ON_RREG(VCN, inst_idx, mmUVD_POWER_STATUS, 1,
                UVD_POWER_STATUS__UVD_POWER_STATUS_MASK);

        /* wait for read ptr to be equal to write ptr */
        tmp = RREG32_SOC15(VCN, inst_idx, mmUVD_RB_WPTR);
        SOC15_WAIT_ON_RREG(VCN, inst_idx, mmUVD_RB_RPTR, tmp, 0xFFFFFFFF);

        tmp = RREG32_SOC15(VCN, inst_idx, mmUVD_RB_WPTR2);
        SOC15_WAIT_ON_RREG(VCN, inst_idx, mmUVD_RB_RPTR2, tmp, 0xFFFFFFFF);

        tmp = RREG32_SOC15(VCN, inst_idx, mmUVD_RBC_RB_WPTR) & 0x7FFFFFFF;
        SOC15_WAIT_ON_RREG(VCN, inst_idx, mmUVD_RBC_RB_RPTR, tmp, 0xFFFFFFFF);

        SOC15_WAIT_ON_RREG(VCN, inst_idx, mmUVD_POWER_STATUS, 1,
                UVD_POWER_STATUS__UVD_POWER_STATUS_MASK);

        /* disable dynamic power gating mode */
        WREG32_P(SOC15_REG_OFFSET(VCN, inst_idx, mmUVD_POWER_STATUS), 0,
                        ~UVD_POWER_STATUS__UVD_PG_MODE_MASK);

        /* Keeping one read-back to ensure all register writes are done,
         * otherwise it may introduce race conditions.
         */
        RREG32_SOC15(VCN, inst_idx, mmUVD_STATUS);

        return 0;
}

static int vcn_v2_5_stop(struct amdgpu_vcn_inst *vinst)
{
        struct amdgpu_device *adev = vinst->adev;
        int i = vinst->inst;
        uint32_t tmp;
        int r;

        if (adev->vcn.harvest_config & (1 << i))
                return 0;

        if (adev->pg_flags & AMD_PG_SUPPORT_VCN_DPG) {
                r = vcn_v2_5_stop_dpg_mode(vinst);
                goto done;
        }

        /* wait for vcn idle */
        r = SOC15_WAIT_ON_RREG(VCN, i, mmUVD_STATUS, UVD_STATUS__IDLE, 0x7);
        if (r)
                goto done;

        tmp = UVD_LMI_STATUS__VCPU_LMI_WRITE_CLEAN_MASK |
                UVD_LMI_STATUS__READ_CLEAN_MASK |
                UVD_LMI_STATUS__WRITE_CLEAN_MASK |
                UVD_LMI_STATUS__WRITE_CLEAN_RAW_MASK;
        r = SOC15_WAIT_ON_RREG(VCN, i, mmUVD_LMI_STATUS, tmp, tmp);
        if (r)
                goto done;

        /* block LMI UMC channel */
        tmp = RREG32_SOC15(VCN, i, mmUVD_LMI_CTRL2);
        tmp |= UVD_LMI_CTRL2__STALL_ARB_UMC_MASK;
        WREG32_SOC15(VCN, i, mmUVD_LMI_CTRL2, tmp);

        tmp = UVD_LMI_STATUS__UMC_READ_CLEAN_RAW_MASK|
                UVD_LMI_STATUS__UMC_WRITE_CLEAN_RAW_MASK;
        r = SOC15_WAIT_ON_RREG(VCN, i, mmUVD_LMI_STATUS, tmp, tmp);
        if (r)
                goto done;

        /* block VCPU register access */
        WREG32_P(SOC15_REG_OFFSET(VCN, i, mmUVD_RB_ARB_CTRL),
                 UVD_RB_ARB_CTRL__VCPU_DIS_MASK,
                 ~UVD_RB_ARB_CTRL__VCPU_DIS_MASK);

        /* reset VCPU */
        WREG32_P(SOC15_REG_OFFSET(VCN, i, mmUVD_VCPU_CNTL),
                 UVD_VCPU_CNTL__BLK_RST_MASK,
                 ~UVD_VCPU_CNTL__BLK_RST_MASK);

        /* disable VCPU clock */
        WREG32_P(SOC15_REG_OFFSET(VCN, i, mmUVD_VCPU_CNTL), 0,
                 ~(UVD_VCPU_CNTL__CLK_EN_MASK));

        /* clear status */
        WREG32_SOC15(VCN, i, mmUVD_STATUS, 0);

        vcn_v2_5_enable_clock_gating(vinst);

        /* enable register anti-hang mechanism */
        WREG32_P(SOC15_REG_OFFSET(VCN, i, mmUVD_POWER_STATUS),
                 UVD_POWER_STATUS__UVD_POWER_STATUS_MASK,
                 ~UVD_POWER_STATUS__UVD_POWER_STATUS_MASK);

        /* Keeping one read-back to ensure all register writes are done,
         * otherwise it may introduce race conditions.
         */
        RREG32_SOC15(VCN, i, mmUVD_STATUS);
done:
        if (adev->pm.dpm_enabled)
                amdgpu_dpm_enable_vcn(adev, false, i);

        return r;
}

static int vcn_v2_5_pause_dpg_mode(struct amdgpu_vcn_inst *vinst,
                                   struct dpg_pause_state *new_state)
{
        struct amdgpu_device *adev = vinst->adev;
        int inst_idx = vinst->inst;
        struct amdgpu_ring *ring;
        uint32_t reg_data = 0;
        int ret_code = 0;

        /* pause/unpause if state is changed */
        if (adev->vcn.inst[inst_idx].pause_state.fw_based != new_state->fw_based) {
                DRM_DEBUG("dpg pause state changed %d -> %d",
                        adev->vcn.inst[inst_idx].pause_state.fw_based,  new_state->fw_based);
                reg_data = RREG32_SOC15(VCN, inst_idx, mmUVD_DPG_PAUSE) &
                        (~UVD_DPG_PAUSE__NJ_PAUSE_DPG_ACK_MASK);

                if (new_state->fw_based == VCN_DPG_STATE__PAUSE) {
                        ret_code = SOC15_WAIT_ON_RREG(VCN, inst_idx, mmUVD_POWER_STATUS, 0x1,
                                UVD_POWER_STATUS__UVD_POWER_STATUS_MASK);

                        if (!ret_code) {
                                struct amdgpu_fw_shared *fw_shared = adev->vcn.inst[inst_idx].fw_shared.cpu_addr;

                                /* pause DPG */
                                reg_data |= UVD_DPG_PAUSE__NJ_PAUSE_DPG_REQ_MASK;
                                WREG32_SOC15(VCN, inst_idx, mmUVD_DPG_PAUSE, reg_data);

                                /* wait for ACK */
                                SOC15_WAIT_ON_RREG(VCN, inst_idx, mmUVD_DPG_PAUSE,
                                           UVD_DPG_PAUSE__NJ_PAUSE_DPG_ACK_MASK,
                                           UVD_DPG_PAUSE__NJ_PAUSE_DPG_ACK_MASK);

                                /* Stall DPG before WPTR/RPTR reset */
                                WREG32_P(SOC15_REG_OFFSET(VCN, inst_idx, mmUVD_POWER_STATUS),
                                           UVD_POWER_STATUS__STALL_DPG_POWER_UP_MASK,
                                           ~UVD_POWER_STATUS__STALL_DPG_POWER_UP_MASK);

                                /* Restore */
                                fw_shared->multi_queue.encode_generalpurpose_queue_mode |= FW_QUEUE_RING_RESET;
                                ring = &adev->vcn.inst[inst_idx].ring_enc[0];
                                ring->wptr = 0;
                                WREG32_SOC15(VCN, inst_idx, mmUVD_RB_BASE_LO, ring->gpu_addr);
                                WREG32_SOC15(VCN, inst_idx, mmUVD_RB_BASE_HI, upper_32_bits(ring->gpu_addr));
                                WREG32_SOC15(VCN, inst_idx, mmUVD_RB_SIZE, ring->ring_size / 4);
                                WREG32_SOC15(VCN, inst_idx, mmUVD_RB_RPTR, lower_32_bits(ring->wptr));
                                WREG32_SOC15(VCN, inst_idx, mmUVD_RB_WPTR, lower_32_bits(ring->wptr));
                                fw_shared->multi_queue.encode_generalpurpose_queue_mode &= ~FW_QUEUE_RING_RESET;

                                fw_shared->multi_queue.encode_lowlatency_queue_mode |= FW_QUEUE_RING_RESET;
                                ring = &adev->vcn.inst[inst_idx].ring_enc[1];
                                ring->wptr = 0;
                                WREG32_SOC15(VCN, inst_idx, mmUVD_RB_BASE_LO2, ring->gpu_addr);
                                WREG32_SOC15(VCN, inst_idx, mmUVD_RB_BASE_HI2, upper_32_bits(ring->gpu_addr));
                                WREG32_SOC15(VCN, inst_idx, mmUVD_RB_SIZE2, ring->ring_size / 4);
                                WREG32_SOC15(VCN, inst_idx, mmUVD_RB_RPTR2, lower_32_bits(ring->wptr));
                                WREG32_SOC15(VCN, inst_idx, mmUVD_RB_WPTR2, lower_32_bits(ring->wptr));
                                fw_shared->multi_queue.encode_lowlatency_queue_mode &= ~FW_QUEUE_RING_RESET;

                                /* Unstall DPG */
                                WREG32_P(SOC15_REG_OFFSET(VCN, inst_idx, mmUVD_POWER_STATUS),
                                           0, ~UVD_POWER_STATUS__STALL_DPG_POWER_UP_MASK);

                                SOC15_WAIT_ON_RREG(VCN, inst_idx, mmUVD_POWER_STATUS,
                                           UVD_PGFSM_CONFIG__UVDM_UVDU_PWR_ON, UVD_POWER_STATUS__UVD_POWER_STATUS_MASK);
                        }
                } else {
                        reg_data &= ~UVD_DPG_PAUSE__NJ_PAUSE_DPG_REQ_MASK;
                        WREG32_SOC15(VCN, inst_idx, mmUVD_DPG_PAUSE, reg_data);
                        SOC15_WAIT_ON_RREG(VCN, inst_idx, mmUVD_POWER_STATUS, 0x1,
                                UVD_POWER_STATUS__UVD_POWER_STATUS_MASK);
                }
                adev->vcn.inst[inst_idx].pause_state.fw_based = new_state->fw_based;
        }

        return 0;
}

/**
 * vcn_v2_5_dec_ring_get_rptr - get read pointer
 *
 * @ring: amdgpu_ring pointer
 *
 * Returns the current hardware read pointer
 */
static uint64_t vcn_v2_5_dec_ring_get_rptr(struct amdgpu_ring *ring)
{
        struct amdgpu_device *adev = ring->adev;

        return RREG32_SOC15(VCN, ring->me, mmUVD_RBC_RB_RPTR);
}

/**
 * vcn_v2_5_dec_ring_get_wptr - get write pointer
 *
 * @ring: amdgpu_ring pointer
 *
 * Returns the current hardware write pointer
 */
static uint64_t vcn_v2_5_dec_ring_get_wptr(struct amdgpu_ring *ring)
{
        struct amdgpu_device *adev = ring->adev;

        if (ring->use_doorbell)
                return *ring->wptr_cpu_addr;
        else
                return RREG32_SOC15(VCN, ring->me, mmUVD_RBC_RB_WPTR);
}

/**
 * vcn_v2_5_dec_ring_set_wptr - set write pointer
 *
 * @ring: amdgpu_ring pointer
 *
 * Commits the write pointer to the hardware
 */
static void vcn_v2_5_dec_ring_set_wptr(struct amdgpu_ring *ring)
{
        struct amdgpu_device *adev = ring->adev;

        if (ring->use_doorbell) {
                *ring->wptr_cpu_addr = lower_32_bits(ring->wptr);
                WDOORBELL32(ring->doorbell_index, lower_32_bits(ring->wptr));
        } else {
                WREG32_SOC15(VCN, ring->me, mmUVD_RBC_RB_WPTR, lower_32_bits(ring->wptr));
        }
}

static const struct amdgpu_ring_funcs vcn_v2_5_dec_ring_vm_funcs = {
        .type = AMDGPU_RING_TYPE_VCN_DEC,
        .align_mask = 0xf,
        .secure_submission_supported = true,
        .get_rptr = vcn_v2_5_dec_ring_get_rptr,
        .get_wptr = vcn_v2_5_dec_ring_get_wptr,
        .set_wptr = vcn_v2_5_dec_ring_set_wptr,
        .emit_frame_size =
                SOC15_FLUSH_GPU_TLB_NUM_WREG * 6 +
                SOC15_FLUSH_GPU_TLB_NUM_REG_WAIT * 8 +
                8 + /* vcn_v2_0_dec_ring_emit_vm_flush */
                14 + 14 + /* vcn_v2_0_dec_ring_emit_fence x2 vm fence */
                6,
        .emit_ib_size = 8, /* vcn_v2_0_dec_ring_emit_ib */
        .emit_ib = vcn_v2_0_dec_ring_emit_ib,
        .emit_fence = vcn_v2_0_dec_ring_emit_fence,
        .emit_vm_flush = vcn_v2_0_dec_ring_emit_vm_flush,
        .test_ring = vcn_v2_0_dec_ring_test_ring,
        .test_ib = amdgpu_vcn_dec_ring_test_ib,
        .insert_nop = vcn_v2_0_dec_ring_insert_nop,
        .insert_start = vcn_v2_0_dec_ring_insert_start,
        .insert_end = vcn_v2_0_dec_ring_insert_end,
        .pad_ib = amdgpu_ring_generic_pad_ib,
        .begin_use = vcn_v2_5_ring_begin_use,
        .end_use = vcn_v2_5_ring_end_use,
        .emit_wreg = vcn_v2_0_dec_ring_emit_wreg,
        .emit_reg_wait = vcn_v2_0_dec_ring_emit_reg_wait,
        .emit_reg_write_reg_wait = amdgpu_ring_emit_reg_write_reg_wait_helper,
        .reset = amdgpu_vcn_ring_reset,
};

/**
 * vcn_v2_5_enc_ring_get_rptr - get enc read pointer
 *
 * @ring: amdgpu_ring pointer
 *
 * Returns the current hardware enc read pointer
 */
static uint64_t vcn_v2_5_enc_ring_get_rptr(struct amdgpu_ring *ring)
{
        struct amdgpu_device *adev = ring->adev;

        if (ring == &adev->vcn.inst[ring->me].ring_enc[0])
                return RREG32_SOC15(VCN, ring->me, mmUVD_RB_RPTR);
        else
                return RREG32_SOC15(VCN, ring->me, mmUVD_RB_RPTR2);
}

/**
 * vcn_v2_5_enc_ring_get_wptr - get enc write pointer
 *
 * @ring: amdgpu_ring pointer
 *
 * Returns the current hardware enc write pointer
 */
static uint64_t vcn_v2_5_enc_ring_get_wptr(struct amdgpu_ring *ring)
{
        struct amdgpu_device *adev = ring->adev;

        if (ring == &adev->vcn.inst[ring->me].ring_enc[0]) {
                if (ring->use_doorbell)
                        return *ring->wptr_cpu_addr;
                else
                        return RREG32_SOC15(VCN, ring->me, mmUVD_RB_WPTR);
        } else {
                if (ring->use_doorbell)
                        return *ring->wptr_cpu_addr;
                else
                        return RREG32_SOC15(VCN, ring->me, mmUVD_RB_WPTR2);
        }
}

/**
 * vcn_v2_5_enc_ring_set_wptr - set enc write pointer
 *
 * @ring: amdgpu_ring pointer
 *
 * Commits the enc write pointer to the hardware
 */
static void vcn_v2_5_enc_ring_set_wptr(struct amdgpu_ring *ring)
{
        struct amdgpu_device *adev = ring->adev;

        if (ring == &adev->vcn.inst[ring->me].ring_enc[0]) {
                if (ring->use_doorbell) {
                        *ring->wptr_cpu_addr = lower_32_bits(ring->wptr);
                        WDOORBELL32(ring->doorbell_index, lower_32_bits(ring->wptr));
                } else {
                        WREG32_SOC15(VCN, ring->me, mmUVD_RB_WPTR, lower_32_bits(ring->wptr));
                }
        } else {
                if (ring->use_doorbell) {
                        *ring->wptr_cpu_addr = lower_32_bits(ring->wptr);
                        WDOORBELL32(ring->doorbell_index, lower_32_bits(ring->wptr));
                } else {
                        WREG32_SOC15(VCN, ring->me, mmUVD_RB_WPTR2, lower_32_bits(ring->wptr));
                }
        }
}

static const struct amdgpu_ring_funcs vcn_v2_5_enc_ring_vm_funcs = {
        .type = AMDGPU_RING_TYPE_VCN_ENC,
        .align_mask = 0x3f,
        .nop = VCN_ENC_CMD_NO_OP,
        .get_rptr = vcn_v2_5_enc_ring_get_rptr,
        .get_wptr = vcn_v2_5_enc_ring_get_wptr,
        .set_wptr = vcn_v2_5_enc_ring_set_wptr,
        .emit_frame_size =
                SOC15_FLUSH_GPU_TLB_NUM_WREG * 3 +
                SOC15_FLUSH_GPU_TLB_NUM_REG_WAIT * 4 +
                4 + /* vcn_v2_0_enc_ring_emit_vm_flush */
                5 + 5 + /* vcn_v2_0_enc_ring_emit_fence x2 vm fence */
                1, /* vcn_v2_0_enc_ring_insert_end */
        .emit_ib_size = 5, /* vcn_v2_0_enc_ring_emit_ib */
        .emit_ib = vcn_v2_0_enc_ring_emit_ib,
        .emit_fence = vcn_v2_0_enc_ring_emit_fence,
        .emit_vm_flush = vcn_v2_0_enc_ring_emit_vm_flush,
        .test_ring = amdgpu_vcn_enc_ring_test_ring,
        .test_ib = amdgpu_vcn_enc_ring_test_ib,
        .insert_nop = amdgpu_ring_insert_nop,
        .insert_end = vcn_v2_0_enc_ring_insert_end,
        .pad_ib = amdgpu_ring_generic_pad_ib,
        .begin_use = vcn_v2_5_ring_begin_use,
        .end_use = vcn_v2_5_ring_end_use,
        .emit_wreg = vcn_v2_0_enc_ring_emit_wreg,
        .emit_reg_wait = vcn_v2_0_enc_ring_emit_reg_wait,
        .emit_reg_write_reg_wait = amdgpu_ring_emit_reg_write_reg_wait_helper,
        .reset = amdgpu_vcn_ring_reset,
};

static void vcn_v2_5_set_dec_ring_funcs(struct amdgpu_device *adev)
{
        int i;

        for (i = 0; i < adev->vcn.num_vcn_inst; ++i) {
                if (adev->vcn.harvest_config & (1 << i))
                        continue;
                adev->vcn.inst[i].ring_dec.funcs = &vcn_v2_5_dec_ring_vm_funcs;
                adev->vcn.inst[i].ring_dec.me = i;
        }
}

static void vcn_v2_5_set_enc_ring_funcs(struct amdgpu_device *adev)
{
        int i, j;

        for (j = 0; j < adev->vcn.num_vcn_inst; ++j) {
                if (adev->vcn.harvest_config & (1 << j))
                        continue;
                for (i = 0; i < adev->vcn.inst[j].num_enc_rings; ++i) {
                        adev->vcn.inst[j].ring_enc[i].funcs = &vcn_v2_5_enc_ring_vm_funcs;
                        adev->vcn.inst[j].ring_enc[i].me = j;
                }
        }
}

static int vcn_v2_5_reset(struct amdgpu_vcn_inst *vinst)
{
        int r;

        r = vcn_v2_5_stop(vinst);
        if (r)
                return r;
        return vcn_v2_5_start(vinst);
}

static bool vcn_v2_5_is_idle(struct amdgpu_ip_block *ip_block)
{
        struct amdgpu_device *adev = ip_block->adev;
        int i, ret = 1;

        for (i = 0; i < adev->vcn.num_vcn_inst; ++i) {
                if (adev->vcn.harvest_config & (1 << i))
                        continue;

                ret &= (RREG32_SOC15(VCN, i, mmUVD_STATUS) == UVD_STATUS__IDLE);
        }

        return ret;
}

static int vcn_v2_5_wait_for_idle(struct amdgpu_ip_block *ip_block)
{
        struct amdgpu_device *adev = ip_block->adev;
        int i, ret = 0;

        for (i = 0; i < adev->vcn.num_vcn_inst; ++i) {
                if (adev->vcn.harvest_config & (1 << i))
                        continue;
                ret = SOC15_WAIT_ON_RREG(VCN, i, mmUVD_STATUS, UVD_STATUS__IDLE,
                        UVD_STATUS__IDLE);
                if (ret)
                        return ret;
        }

        return ret;
}

static int vcn_v2_5_set_clockgating_state(struct amdgpu_ip_block *ip_block,
                                          enum amd_clockgating_state state)
{
        struct amdgpu_device *adev = ip_block->adev;
        bool enable = (state == AMD_CG_STATE_GATE);
        int i;

        if (amdgpu_sriov_vf(adev))
                return 0;

        for (i = 0; i < adev->vcn.num_vcn_inst; ++i) {
                struct amdgpu_vcn_inst *vinst = &adev->vcn.inst[i];

                if (enable) {
                        if (!vcn_v2_5_is_idle(ip_block))
                                return -EBUSY;
                        vcn_v2_5_enable_clock_gating(vinst);
                } else {
                        vcn_v2_5_disable_clock_gating(vinst);
                }
        }

        return 0;
}

static int vcn_v2_5_set_pg_state(struct amdgpu_vcn_inst *vinst,
                                 enum amd_powergating_state state)
{
        struct amdgpu_device *adev = vinst->adev;
        int ret;

        if (amdgpu_sriov_vf(adev))
                return 0;

        if (state == vinst->cur_state)
                return 0;

        if (state == AMD_PG_STATE_GATE)
                ret = vcn_v2_5_stop(vinst);
        else
                ret = vcn_v2_5_start(vinst);

        if (!ret)
                vinst->cur_state = state;

        return ret;
}

static int vcn_v2_5_set_interrupt_state(struct amdgpu_device *adev,
                                        struct amdgpu_irq_src *source,
                                        unsigned type,
                                        enum amdgpu_interrupt_state state)
{
        return 0;
}

static int vcn_v2_6_set_ras_interrupt_state(struct amdgpu_device *adev,
                                        struct amdgpu_irq_src *source,
                                        unsigned int type,
                                        enum amdgpu_interrupt_state state)
{
        return 0;
}

static int vcn_v2_5_process_interrupt(struct amdgpu_device *adev,
                                      struct amdgpu_irq_src *source,
                                      struct amdgpu_iv_entry *entry)
{
        uint32_t ip_instance;

        switch (entry->client_id) {
        case SOC15_IH_CLIENTID_VCN:
                ip_instance = 0;
                break;
        case SOC15_IH_CLIENTID_VCN1:
                ip_instance = 1;
                break;
        default:
                DRM_ERROR("Unhandled client id: %d\n", entry->client_id);
                return 0;
        }

        DRM_DEBUG("IH: VCN TRAP\n");

        switch (entry->src_id) {
        case VCN_2_0__SRCID__UVD_SYSTEM_MESSAGE_INTERRUPT:
                amdgpu_fence_process(&adev->vcn.inst[ip_instance].ring_dec);
                break;
        case VCN_2_0__SRCID__UVD_ENC_GENERAL_PURPOSE:
                amdgpu_fence_process(&adev->vcn.inst[ip_instance].ring_enc[0]);
                break;
        case VCN_2_0__SRCID__UVD_ENC_LOW_LATENCY:
                amdgpu_fence_process(&adev->vcn.inst[ip_instance].ring_enc[1]);
                break;
        default:
                DRM_ERROR("Unhandled interrupt: %d %d\n",
                          entry->src_id, entry->src_data[0]);
                break;
        }

        return 0;
}

static const struct amdgpu_irq_src_funcs vcn_v2_5_irq_funcs = {
        .set = vcn_v2_5_set_interrupt_state,
        .process = vcn_v2_5_process_interrupt,
};

static const struct amdgpu_irq_src_funcs vcn_v2_6_ras_irq_funcs = {
        .set = vcn_v2_6_set_ras_interrupt_state,
        .process = amdgpu_vcn_process_poison_irq,
};

static void vcn_v2_5_set_irq_funcs(struct amdgpu_device *adev)
{
        int i;

        for (i = 0; i < adev->vcn.num_vcn_inst; ++i) {
                if (adev->vcn.harvest_config & (1 << i))
                        continue;
                adev->vcn.inst[i].irq.num_types = adev->vcn.inst[i].num_enc_rings + 1;
                adev->vcn.inst[i].irq.funcs = &vcn_v2_5_irq_funcs;

                adev->vcn.inst[i].ras_poison_irq.num_types = adev->vcn.inst[i].num_enc_rings + 1;
                adev->vcn.inst[i].ras_poison_irq.funcs = &vcn_v2_6_ras_irq_funcs;
        }
}

static const struct amd_ip_funcs vcn_v2_5_ip_funcs = {
        .name = "vcn_v2_5",
        .early_init = vcn_v2_5_early_init,
        .sw_init = vcn_v2_5_sw_init,
        .sw_fini = vcn_v2_5_sw_fini,
        .hw_init = vcn_v2_5_hw_init,
        .hw_fini = vcn_v2_5_hw_fini,
        .suspend = vcn_v2_5_suspend,
        .resume = vcn_v2_5_resume,
        .is_idle = vcn_v2_5_is_idle,
        .wait_for_idle = vcn_v2_5_wait_for_idle,
        .set_clockgating_state = vcn_v2_5_set_clockgating_state,
        .set_powergating_state = vcn_set_powergating_state,
        .dump_ip_state = amdgpu_vcn_dump_ip_state,
        .print_ip_state = amdgpu_vcn_print_ip_state,
};

static const struct amd_ip_funcs vcn_v2_6_ip_funcs = {
        .name = "vcn_v2_6",
        .early_init = vcn_v2_5_early_init,
        .sw_init = vcn_v2_5_sw_init,
        .sw_fini = vcn_v2_5_sw_fini,
        .hw_init = vcn_v2_5_hw_init,
        .hw_fini = vcn_v2_5_hw_fini,
        .suspend = vcn_v2_5_suspend,
        .resume = vcn_v2_5_resume,
        .is_idle = vcn_v2_5_is_idle,
        .wait_for_idle = vcn_v2_5_wait_for_idle,
        .set_clockgating_state = vcn_v2_5_set_clockgating_state,
        .set_powergating_state = vcn_set_powergating_state,
        .dump_ip_state = amdgpu_vcn_dump_ip_state,
        .print_ip_state = amdgpu_vcn_print_ip_state,
};

const struct amdgpu_ip_block_version vcn_v2_5_ip_block =
{
                .type = AMD_IP_BLOCK_TYPE_VCN,
                .major = 2,
                .minor = 5,
                .rev = 0,
                .funcs = &vcn_v2_5_ip_funcs,
};

const struct amdgpu_ip_block_version vcn_v2_6_ip_block =
{
                .type = AMD_IP_BLOCK_TYPE_VCN,
                .major = 2,
                .minor = 6,
                .rev = 0,
                .funcs = &vcn_v2_6_ip_funcs,
};

static uint32_t vcn_v2_6_query_poison_by_instance(struct amdgpu_device *adev,
                        uint32_t instance, uint32_t sub_block)
{
        uint32_t poison_stat = 0, reg_value = 0;

        switch (sub_block) {
        case AMDGPU_VCN_V2_6_VCPU_VCODEC:
                reg_value = RREG32_SOC15(VCN, instance, mmUVD_RAS_VCPU_VCODEC_STATUS);
                poison_stat = REG_GET_FIELD(reg_value, UVD_RAS_VCPU_VCODEC_STATUS, POISONED_PF);
                break;
        default:
                break;
        }

        if (poison_stat)
                dev_info(adev->dev, "Poison detected in VCN%d, sub_block%d\n",
                        instance, sub_block);

        return poison_stat;
}

static bool vcn_v2_6_query_poison_status(struct amdgpu_device *adev)
{
        uint32_t inst, sub;
        uint32_t poison_stat = 0;

        for (inst = 0; inst < adev->vcn.num_vcn_inst; inst++)
                for (sub = 0; sub < AMDGPU_VCN_V2_6_MAX_SUB_BLOCK; sub++)
                        poison_stat +=
                        vcn_v2_6_query_poison_by_instance(adev, inst, sub);

        return !!poison_stat;
}

const struct amdgpu_ras_block_hw_ops vcn_v2_6_ras_hw_ops = {
        .query_poison_status = vcn_v2_6_query_poison_status,
};

static struct amdgpu_vcn_ras vcn_v2_6_ras = {
        .ras_block = {
                .hw_ops = &vcn_v2_6_ras_hw_ops,
                .ras_late_init = amdgpu_vcn_ras_late_init,
        },
};

static void vcn_v2_5_set_ras_funcs(struct amdgpu_device *adev)
{
        switch (amdgpu_ip_version(adev, VCN_HWIP, 0)) {
        case IP_VERSION(2, 6, 0):
                adev->vcn.ras = &vcn_v2_6_ras;
                break;
        default:
                break;
        }
}
Linux
