| /* | |
| * Copyright 2021 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 "sienna_cichlid.h" | |
| #include "amdgpu_reset.h" | |
| #include "amdgpu_amdkfd.h" | |
| #include "amdgpu_dpm.h" | |
| #include "amdgpu_job.h" | |
| #include "amdgpu_ring.h" | |
| #include "amdgpu_ras.h" | |
| #include "amdgpu_psp.h" | |
| #include "amdgpu_xgmi.h" | |
| static bool sienna_cichlid_is_mode2_default(struct amdgpu_reset_control *reset_ctl) | |
| { | |
| #if 0 | |
| struct amdgpu_device *adev = (struct amdgpu_device *)reset_ctl->handle; | |
| if (amdgpu_ip_version(adev, MP1_HWIP, 0) == IP_VERSION(11, 0, 7) && | |
| adev->pm.fw_version >= 0x3a5500 && !amdgpu_sriov_vf(adev)) | |
| return true; | |
| #endif | |
| return amdgpu_reset_method == AMD_RESET_METHOD_MODE2; | |
| } | |
| static struct amdgpu_reset_handler * | |
| sienna_cichlid_get_reset_handler(struct amdgpu_reset_control *reset_ctl, | |
| struct amdgpu_reset_context *reset_context) | |
| { | |
| struct amdgpu_reset_handler *handler; | |
| int i; | |
| if (reset_context->method != AMD_RESET_METHOD_NONE) { | |
| for_each_handler(i, handler, reset_ctl) { | |
| if (handler->reset_method == reset_context->method) | |
| return handler; | |
| } | |
| } | |
| if (sienna_cichlid_is_mode2_default(reset_ctl)) { | |
| for_each_handler(i, handler, reset_ctl) { | |
| if (handler->reset_method == AMD_RESET_METHOD_MODE2) | |
| return handler; | |
| } | |
| } | |
| return NULL; | |
| } | |
| static int sienna_cichlid_mode2_suspend_ip(struct amdgpu_device *adev) | |
| { | |
| int r, i; | |
| amdgpu_device_set_pg_state(adev, AMD_PG_STATE_UNGATE); | |
| amdgpu_device_set_cg_state(adev, AMD_CG_STATE_UNGATE); | |
| for (i = adev->num_ip_blocks - 1; i >= 0; i--) { | |
| if (!(adev->ip_blocks[i].version->type == | |
| AMD_IP_BLOCK_TYPE_GFX || | |
| adev->ip_blocks[i].version->type == | |
| AMD_IP_BLOCK_TYPE_SDMA)) | |
| continue; | |
| r = amdgpu_ip_block_suspend(&adev->ip_blocks[i]); | |
| if (r) | |
| return r; | |
| } | |
| return 0; | |
| } | |
| static int | |
| sienna_cichlid_mode2_prepare_hwcontext(struct amdgpu_reset_control *reset_ctl, | |
| struct amdgpu_reset_context *reset_context) | |
| { | |
| int r = 0; | |
| struct amdgpu_device *adev = (struct amdgpu_device *)reset_ctl->handle; | |
| if (!amdgpu_sriov_vf(adev)) { | |
| if (adev->gfxhub.funcs->mode2_save_regs) | |
| adev->gfxhub.funcs->mode2_save_regs(adev); | |
| if (adev->gfxhub.funcs->halt) | |
| adev->gfxhub.funcs->halt(adev); | |
| r = sienna_cichlid_mode2_suspend_ip(adev); | |
| } | |
| return r; | |
| } | |
| static void sienna_cichlid_async_reset(struct work_struct *work) | |
| { | |
| struct amdgpu_reset_handler *handler; | |
| struct amdgpu_reset_control *reset_ctl = | |
| container_of(work, struct amdgpu_reset_control, reset_work); | |
| struct amdgpu_device *adev = (struct amdgpu_device *)reset_ctl->handle; | |
| int i; | |
| for_each_handler(i, handler, reset_ctl) { | |
| if (handler->reset_method == reset_ctl->active_reset) { | |
| dev_dbg(adev->dev, "Resetting device\n"); | |
| handler->do_reset(adev); | |
| break; | |
| } | |
| } | |
| } | |
| static int sienna_cichlid_mode2_reset(struct amdgpu_device *adev) | |
| { | |
| /* disable BM */ | |
| pci_clear_master(adev->pdev); | |
| return amdgpu_dpm_mode2_reset(adev); | |
| } | |
| static int | |
| sienna_cichlid_mode2_perform_reset(struct amdgpu_reset_control *reset_ctl, | |
| struct amdgpu_reset_context *reset_context) | |
| { | |
| struct amdgpu_device *adev = (struct amdgpu_device *)reset_ctl->handle; | |
| int r; | |
| r = sienna_cichlid_mode2_reset(adev); | |
| if (r) { | |
| dev_err(adev->dev, | |
| "ASIC reset failed with error, %d ", r); | |
| } | |
| return r; | |
| } | |
| static int sienna_cichlid_mode2_restore_ip(struct amdgpu_device *adev) | |
| { | |
| int i, r; | |
| struct psp_context *psp = &adev->psp; | |
| r = psp_rlc_autoload_start(psp); | |
| if (r) { | |
| dev_err(adev->dev, "Failed to start rlc autoload\n"); | |
| return r; | |
| } | |
| /* Reinit GFXHUB */ | |
| if (adev->gfxhub.funcs->mode2_restore_regs) | |
| adev->gfxhub.funcs->mode2_restore_regs(adev); | |
| adev->gfxhub.funcs->init(adev); | |
| r = adev->gfxhub.funcs->gart_enable(adev); | |
| if (r) { | |
| dev_err(adev->dev, "GFXHUB gart reenable failed after reset\n"); | |
| return r; | |
| } | |
| for (i = 0; i < adev->num_ip_blocks; i++) { | |
| if (adev->ip_blocks[i].version->type == AMD_IP_BLOCK_TYPE_IH) { | |
| r = amdgpu_ip_block_resume(&adev->ip_blocks[i]); | |
| if (r) | |
| return r; | |
| } | |
| } | |
| for (i = 0; i < adev->num_ip_blocks; i++) { | |
| if (!(adev->ip_blocks[i].version->type == | |
| AMD_IP_BLOCK_TYPE_GFX || | |
| adev->ip_blocks[i].version->type == | |
| AMD_IP_BLOCK_TYPE_SDMA)) | |
| continue; | |
| r = amdgpu_ip_block_resume(&adev->ip_blocks[i]); | |
| if (r) | |
| return r; | |
| } | |
| for (i = 0; i < adev->num_ip_blocks; i++) { | |
| if (!(adev->ip_blocks[i].version->type == | |
| AMD_IP_BLOCK_TYPE_GFX || | |
| adev->ip_blocks[i].version->type == | |
| AMD_IP_BLOCK_TYPE_SDMA)) | |
| continue; | |
| if (adev->ip_blocks[i].version->funcs->late_init) { | |
| r = adev->ip_blocks[i].version->funcs->late_init( | |
| &adev->ip_blocks[i]); | |
| if (r) { | |
| dev_err(adev->dev, | |
| "late_init of IP block <%s> failed %d after reset\n", | |
| adev->ip_blocks[i].version->funcs->name, | |
| r); | |
| return r; | |
| } | |
| } | |
| adev->ip_blocks[i].status.late_initialized = true; | |
| } | |
| amdgpu_device_set_cg_state(adev, AMD_CG_STATE_GATE); | |
| amdgpu_device_set_pg_state(adev, AMD_PG_STATE_GATE); | |
| return r; | |
| } | |
| static int | |
| sienna_cichlid_mode2_restore_hwcontext(struct amdgpu_reset_control *reset_ctl, | |
| struct amdgpu_reset_context *reset_context) | |
| { | |
| int r; | |
| struct amdgpu_device *tmp_adev = (struct amdgpu_device *)reset_ctl->handle; | |
| amdgpu_set_init_level(tmp_adev, AMDGPU_INIT_LEVEL_RESET_RECOVERY); | |
| dev_info(tmp_adev->dev, | |
| "GPU reset succeeded, trying to resume\n"); | |
| r = sienna_cichlid_mode2_restore_ip(tmp_adev); | |
| if (r) | |
| goto end; | |
| /* | |
| * Add this ASIC as tracked as reset was already | |
| * complete successfully. | |
| */ | |
| amdgpu_register_gpu_instance(tmp_adev); | |
| /* Resume RAS */ | |
| amdgpu_ras_resume(tmp_adev); | |
| amdgpu_irq_gpu_reset_resume_helper(tmp_adev); | |
| amdgpu_set_init_level(tmp_adev, AMDGPU_INIT_LEVEL_DEFAULT); | |
| r = amdgpu_ib_ring_tests(tmp_adev); | |
| if (r) { | |
| dev_err(tmp_adev->dev, | |
| "ib ring test failed (%d).\n", r); | |
| r = -EAGAIN; | |
| goto end; | |
| } | |
| end: | |
| if (r) | |
| return -EAGAIN; | |
| else | |
| return r; | |
| } | |
| static struct amdgpu_reset_handler sienna_cichlid_mode2_handler = { | |
| .reset_method = AMD_RESET_METHOD_MODE2, | |
| .prepare_env = NULL, | |
| .prepare_hwcontext = sienna_cichlid_mode2_prepare_hwcontext, | |
| .perform_reset = sienna_cichlid_mode2_perform_reset, | |
| .restore_hwcontext = sienna_cichlid_mode2_restore_hwcontext, | |
| .restore_env = NULL, | |
| .do_reset = sienna_cichlid_mode2_reset, | |
| }; | |
| static struct amdgpu_reset_handler | |
| *sienna_cichlid_rst_handlers[AMDGPU_RESET_MAX_HANDLERS] = { | |
| &sienna_cichlid_mode2_handler, | |
| }; | |
| int sienna_cichlid_reset_init(struct amdgpu_device *adev) | |
| { | |
| struct amdgpu_reset_control *reset_ctl; | |
| reset_ctl = kzalloc_obj(*reset_ctl); | |
| if (!reset_ctl) | |
| return -ENOMEM; | |
| reset_ctl->handle = adev; | |
| reset_ctl->async_reset = sienna_cichlid_async_reset; | |
| reset_ctl->active_reset = AMD_RESET_METHOD_NONE; | |
| reset_ctl->get_reset_handler = sienna_cichlid_get_reset_handler; | |
| INIT_WORK(&reset_ctl->reset_work, reset_ctl->async_reset); | |
| /* Only mode2 is handled through reset control now */ | |
| reset_ctl->reset_handlers = &sienna_cichlid_rst_handlers; | |
| adev->reset_cntl = reset_ctl; | |
| return 0; | |
| } | |
| int sienna_cichlid_reset_fini(struct amdgpu_device *adev) | |
| { | |
| kfree(adev->reset_cntl); | |
| adev->reset_cntl = NULL; | |
| return 0; | |
| } |