649 lines
18 KiB
C
649 lines
18 KiB
C
/*
|
|
* Copyright 2015 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.
|
|
*
|
|
* Authors: AMD
|
|
*
|
|
*/
|
|
|
|
#include <linux/irqdomain.h>
|
|
#include <linux/pci.h>
|
|
#include <linux/pm_domain.h>
|
|
#include <linux/platform_device.h>
|
|
#include <sound/designware_i2s.h>
|
|
#include <sound/pcm.h>
|
|
#include <linux/acpi.h>
|
|
#include <linux/dmi.h>
|
|
|
|
#include "amdgpu.h"
|
|
#include "atom.h"
|
|
#include "amdgpu_acp.h"
|
|
|
|
#include "acp_gfx_if.h"
|
|
|
|
#define ST_JADEITE 1
|
|
#define ACP_TILE_ON_MASK 0x03
|
|
#define ACP_TILE_OFF_MASK 0x02
|
|
#define ACP_TILE_ON_RETAIN_REG_MASK 0x1f
|
|
#define ACP_TILE_OFF_RETAIN_REG_MASK 0x20
|
|
|
|
#define ACP_TILE_P1_MASK 0x3e
|
|
#define ACP_TILE_P2_MASK 0x3d
|
|
#define ACP_TILE_DSP0_MASK 0x3b
|
|
#define ACP_TILE_DSP1_MASK 0x37
|
|
|
|
#define ACP_TILE_DSP2_MASK 0x2f
|
|
|
|
#define ACP_DMA_REGS_END 0x146c0
|
|
#define ACP_I2S_PLAY_REGS_START 0x14840
|
|
#define ACP_I2S_PLAY_REGS_END 0x148b4
|
|
#define ACP_I2S_CAP_REGS_START 0x148b8
|
|
#define ACP_I2S_CAP_REGS_END 0x1496c
|
|
|
|
#define ACP_I2S_COMP1_CAP_REG_OFFSET 0xac
|
|
#define ACP_I2S_COMP2_CAP_REG_OFFSET 0xa8
|
|
#define ACP_I2S_COMP1_PLAY_REG_OFFSET 0x6c
|
|
#define ACP_I2S_COMP2_PLAY_REG_OFFSET 0x68
|
|
#define ACP_BT_PLAY_REGS_START 0x14970
|
|
#define ACP_BT_PLAY_REGS_END 0x14a24
|
|
#define ACP_BT_COMP1_REG_OFFSET 0xac
|
|
#define ACP_BT_COMP2_REG_OFFSET 0xa8
|
|
|
|
#define mmACP_PGFSM_RETAIN_REG 0x51c9
|
|
#define mmACP_PGFSM_CONFIG_REG 0x51ca
|
|
#define mmACP_PGFSM_READ_REG_0 0x51cc
|
|
|
|
#define mmACP_MEM_SHUT_DOWN_REQ_LO 0x51f8
|
|
#define mmACP_MEM_SHUT_DOWN_REQ_HI 0x51f9
|
|
#define mmACP_MEM_SHUT_DOWN_STS_LO 0x51fa
|
|
#define mmACP_MEM_SHUT_DOWN_STS_HI 0x51fb
|
|
|
|
#define mmACP_CONTROL 0x5131
|
|
#define mmACP_STATUS 0x5133
|
|
#define mmACP_SOFT_RESET 0x5134
|
|
#define ACP_CONTROL__ClkEn_MASK 0x1
|
|
#define ACP_SOFT_RESET__SoftResetAud_MASK 0x100
|
|
#define ACP_SOFT_RESET__SoftResetAudDone_MASK 0x1000000
|
|
#define ACP_CLOCK_EN_TIME_OUT_VALUE 0x000000FF
|
|
#define ACP_SOFT_RESET_DONE_TIME_OUT_VALUE 0x000000FF
|
|
|
|
#define ACP_TIMEOUT_LOOP 0x000000FF
|
|
#define ACP_DEVS 4
|
|
#define ACP_SRC_ID 162
|
|
|
|
static unsigned long acp_machine_id;
|
|
|
|
enum {
|
|
ACP_TILE_P1 = 0,
|
|
ACP_TILE_P2,
|
|
ACP_TILE_DSP0,
|
|
ACP_TILE_DSP1,
|
|
ACP_TILE_DSP2,
|
|
};
|
|
|
|
static int acp_sw_init(void *handle)
|
|
{
|
|
struct amdgpu_device *adev = (struct amdgpu_device *)handle;
|
|
|
|
adev->acp.parent = adev->dev;
|
|
|
|
adev->acp.cgs_device =
|
|
amdgpu_cgs_create_device(adev);
|
|
if (!adev->acp.cgs_device)
|
|
return -EINVAL;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int acp_sw_fini(void *handle)
|
|
{
|
|
struct amdgpu_device *adev = (struct amdgpu_device *)handle;
|
|
|
|
if (adev->acp.cgs_device)
|
|
amdgpu_cgs_destroy_device(adev->acp.cgs_device);
|
|
|
|
return 0;
|
|
}
|
|
|
|
struct acp_pm_domain {
|
|
void *adev;
|
|
struct generic_pm_domain gpd;
|
|
};
|
|
|
|
static int acp_poweroff(struct generic_pm_domain *genpd)
|
|
{
|
|
struct acp_pm_domain *apd;
|
|
struct amdgpu_device *adev;
|
|
|
|
apd = container_of(genpd, struct acp_pm_domain, gpd);
|
|
adev = apd->adev;
|
|
/* call smu to POWER GATE ACP block
|
|
* smu will
|
|
* 1. turn off the acp clock
|
|
* 2. power off the acp tiles
|
|
* 3. check and enter ulv state
|
|
*/
|
|
amdgpu_dpm_set_powergating_by_smu(adev, AMD_IP_BLOCK_TYPE_ACP, true);
|
|
return 0;
|
|
}
|
|
|
|
static int acp_poweron(struct generic_pm_domain *genpd)
|
|
{
|
|
struct acp_pm_domain *apd;
|
|
struct amdgpu_device *adev;
|
|
|
|
apd = container_of(genpd, struct acp_pm_domain, gpd);
|
|
adev = apd->adev;
|
|
/* call smu to UNGATE ACP block
|
|
* smu will
|
|
* 1. exit ulv
|
|
* 2. turn on acp clock
|
|
* 3. power on acp tiles
|
|
*/
|
|
amdgpu_dpm_set_powergating_by_smu(adev, AMD_IP_BLOCK_TYPE_ACP, false);
|
|
return 0;
|
|
}
|
|
|
|
static int acp_genpd_add_device(struct device *dev, void *data)
|
|
{
|
|
struct generic_pm_domain *gpd = data;
|
|
int ret;
|
|
|
|
ret = pm_genpd_add_device(gpd, dev);
|
|
if (ret)
|
|
dev_err(dev, "Failed to add dev to genpd %d\n", ret);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int acp_genpd_remove_device(struct device *dev, void *data)
|
|
{
|
|
int ret;
|
|
|
|
ret = pm_genpd_remove_device(dev);
|
|
if (ret)
|
|
dev_err(dev, "Failed to remove dev from genpd %d\n", ret);
|
|
|
|
/* Continue to remove */
|
|
return 0;
|
|
}
|
|
|
|
static int acp_quirk_cb(const struct dmi_system_id *id)
|
|
{
|
|
acp_machine_id = ST_JADEITE;
|
|
return 1;
|
|
}
|
|
|
|
static const struct dmi_system_id acp_quirk_table[] = {
|
|
{
|
|
.callback = acp_quirk_cb,
|
|
.matches = {
|
|
DMI_EXACT_MATCH(DMI_BOARD_VENDOR, "AMD"),
|
|
DMI_EXACT_MATCH(DMI_PRODUCT_NAME, "Jadeite"),
|
|
}
|
|
},
|
|
{
|
|
.callback = acp_quirk_cb,
|
|
.matches = {
|
|
DMI_EXACT_MATCH(DMI_BOARD_VENDOR, "IP3 Technology CO.,Ltd."),
|
|
DMI_EXACT_MATCH(DMI_PRODUCT_NAME, "ASN1D"),
|
|
},
|
|
},
|
|
{
|
|
.callback = acp_quirk_cb,
|
|
.matches = {
|
|
DMI_EXACT_MATCH(DMI_BOARD_VENDOR, "Standard"),
|
|
DMI_EXACT_MATCH(DMI_PRODUCT_NAME, "ASN10"),
|
|
},
|
|
},
|
|
{}
|
|
};
|
|
|
|
/**
|
|
* acp_hw_init - start and test ACP block
|
|
*
|
|
* @handle: handle used to pass amdgpu_device pointer
|
|
*
|
|
*/
|
|
static int acp_hw_init(void *handle)
|
|
{
|
|
int r;
|
|
u64 acp_base;
|
|
u32 val = 0;
|
|
u32 count = 0;
|
|
struct i2s_platform_data *i2s_pdata = NULL;
|
|
|
|
struct amdgpu_device *adev = (struct amdgpu_device *)handle;
|
|
|
|
const struct amdgpu_ip_block *ip_block =
|
|
amdgpu_device_ip_get_ip_block(adev, AMD_IP_BLOCK_TYPE_ACP);
|
|
|
|
if (!ip_block)
|
|
return -EINVAL;
|
|
|
|
r = amd_acp_hw_init(adev->acp.cgs_device,
|
|
ip_block->version->major, ip_block->version->minor);
|
|
/* -ENODEV means board uses AZ rather than ACP */
|
|
if (r == -ENODEV) {
|
|
amdgpu_dpm_set_powergating_by_smu(adev, AMD_IP_BLOCK_TYPE_ACP, true);
|
|
return 0;
|
|
} else if (r) {
|
|
return r;
|
|
}
|
|
|
|
if (adev->rmmio_size == 0 || adev->rmmio_size < 0x5289)
|
|
return -EINVAL;
|
|
|
|
acp_base = adev->rmmio_base;
|
|
adev->acp.acp_genpd = kzalloc(sizeof(struct acp_pm_domain), GFP_KERNEL);
|
|
if (!adev->acp.acp_genpd)
|
|
return -ENOMEM;
|
|
|
|
adev->acp.acp_genpd->gpd.name = "ACP_AUDIO";
|
|
adev->acp.acp_genpd->gpd.power_off = acp_poweroff;
|
|
adev->acp.acp_genpd->gpd.power_on = acp_poweron;
|
|
adev->acp.acp_genpd->adev = adev;
|
|
|
|
pm_genpd_init(&adev->acp.acp_genpd->gpd, NULL, false);
|
|
dmi_check_system(acp_quirk_table);
|
|
switch (acp_machine_id) {
|
|
case ST_JADEITE:
|
|
{
|
|
adev->acp.acp_cell = kcalloc(2, sizeof(struct mfd_cell),
|
|
GFP_KERNEL);
|
|
if (!adev->acp.acp_cell) {
|
|
r = -ENOMEM;
|
|
goto failure;
|
|
}
|
|
|
|
adev->acp.acp_res = kcalloc(3, sizeof(struct resource), GFP_KERNEL);
|
|
if (!adev->acp.acp_res) {
|
|
r = -ENOMEM;
|
|
goto failure;
|
|
}
|
|
|
|
i2s_pdata = kcalloc(1, sizeof(struct i2s_platform_data), GFP_KERNEL);
|
|
if (!i2s_pdata) {
|
|
r = -ENOMEM;
|
|
goto failure;
|
|
}
|
|
|
|
i2s_pdata[0].quirks = DW_I2S_QUIRK_COMP_REG_OFFSET |
|
|
DW_I2S_QUIRK_16BIT_IDX_OVERRIDE;
|
|
i2s_pdata[0].cap = DWC_I2S_PLAY | DWC_I2S_RECORD;
|
|
i2s_pdata[0].snd_rates = SNDRV_PCM_RATE_8000_96000;
|
|
i2s_pdata[0].i2s_reg_comp1 = ACP_I2S_COMP1_CAP_REG_OFFSET;
|
|
i2s_pdata[0].i2s_reg_comp2 = ACP_I2S_COMP2_CAP_REG_OFFSET;
|
|
|
|
adev->acp.acp_res[0].name = "acp2x_dma";
|
|
adev->acp.acp_res[0].flags = IORESOURCE_MEM;
|
|
adev->acp.acp_res[0].start = acp_base;
|
|
adev->acp.acp_res[0].end = acp_base + ACP_DMA_REGS_END;
|
|
|
|
adev->acp.acp_res[1].name = "acp2x_dw_i2s_play_cap";
|
|
adev->acp.acp_res[1].flags = IORESOURCE_MEM;
|
|
adev->acp.acp_res[1].start = acp_base + ACP_I2S_CAP_REGS_START;
|
|
adev->acp.acp_res[1].end = acp_base + ACP_I2S_CAP_REGS_END;
|
|
|
|
adev->acp.acp_res[2].name = "acp2x_dma_irq";
|
|
adev->acp.acp_res[2].flags = IORESOURCE_IRQ;
|
|
adev->acp.acp_res[2].start = amdgpu_irq_create_mapping(adev, 162);
|
|
adev->acp.acp_res[2].end = adev->acp.acp_res[2].start;
|
|
|
|
adev->acp.acp_cell[0].name = "acp_audio_dma";
|
|
adev->acp.acp_cell[0].num_resources = 3;
|
|
adev->acp.acp_cell[0].resources = &adev->acp.acp_res[0];
|
|
adev->acp.acp_cell[0].platform_data = &adev->asic_type;
|
|
adev->acp.acp_cell[0].pdata_size = sizeof(adev->asic_type);
|
|
|
|
adev->acp.acp_cell[1].name = "designware-i2s";
|
|
adev->acp.acp_cell[1].num_resources = 1;
|
|
adev->acp.acp_cell[1].resources = &adev->acp.acp_res[1];
|
|
adev->acp.acp_cell[1].platform_data = &i2s_pdata[0];
|
|
adev->acp.acp_cell[1].pdata_size = sizeof(struct i2s_platform_data);
|
|
r = mfd_add_hotplug_devices(adev->acp.parent, adev->acp.acp_cell, 2);
|
|
if (r)
|
|
goto failure;
|
|
r = device_for_each_child(adev->acp.parent, &adev->acp.acp_genpd->gpd,
|
|
acp_genpd_add_device);
|
|
if (r)
|
|
goto failure;
|
|
break;
|
|
}
|
|
default:
|
|
adev->acp.acp_cell = kcalloc(ACP_DEVS, sizeof(struct mfd_cell),
|
|
GFP_KERNEL);
|
|
|
|
if (!adev->acp.acp_cell) {
|
|
r = -ENOMEM;
|
|
goto failure;
|
|
}
|
|
|
|
adev->acp.acp_res = kcalloc(5, sizeof(struct resource), GFP_KERNEL);
|
|
if (!adev->acp.acp_res) {
|
|
r = -ENOMEM;
|
|
goto failure;
|
|
}
|
|
|
|
i2s_pdata = kcalloc(3, sizeof(struct i2s_platform_data), GFP_KERNEL);
|
|
if (!i2s_pdata) {
|
|
r = -ENOMEM;
|
|
goto failure;
|
|
}
|
|
|
|
switch (adev->asic_type) {
|
|
case CHIP_STONEY:
|
|
i2s_pdata[0].quirks = DW_I2S_QUIRK_COMP_REG_OFFSET |
|
|
DW_I2S_QUIRK_16BIT_IDX_OVERRIDE;
|
|
break;
|
|
default:
|
|
i2s_pdata[0].quirks = DW_I2S_QUIRK_COMP_REG_OFFSET;
|
|
}
|
|
i2s_pdata[0].cap = DWC_I2S_PLAY;
|
|
i2s_pdata[0].snd_rates = SNDRV_PCM_RATE_8000_96000;
|
|
i2s_pdata[0].i2s_reg_comp1 = ACP_I2S_COMP1_PLAY_REG_OFFSET;
|
|
i2s_pdata[0].i2s_reg_comp2 = ACP_I2S_COMP2_PLAY_REG_OFFSET;
|
|
switch (adev->asic_type) {
|
|
case CHIP_STONEY:
|
|
i2s_pdata[1].quirks = DW_I2S_QUIRK_COMP_REG_OFFSET |
|
|
DW_I2S_QUIRK_COMP_PARAM1 |
|
|
DW_I2S_QUIRK_16BIT_IDX_OVERRIDE;
|
|
break;
|
|
default:
|
|
i2s_pdata[1].quirks = DW_I2S_QUIRK_COMP_REG_OFFSET |
|
|
DW_I2S_QUIRK_COMP_PARAM1;
|
|
}
|
|
|
|
i2s_pdata[1].cap = DWC_I2S_RECORD;
|
|
i2s_pdata[1].snd_rates = SNDRV_PCM_RATE_8000_96000;
|
|
i2s_pdata[1].i2s_reg_comp1 = ACP_I2S_COMP1_CAP_REG_OFFSET;
|
|
i2s_pdata[1].i2s_reg_comp2 = ACP_I2S_COMP2_CAP_REG_OFFSET;
|
|
|
|
i2s_pdata[2].quirks = DW_I2S_QUIRK_COMP_REG_OFFSET;
|
|
switch (adev->asic_type) {
|
|
case CHIP_STONEY:
|
|
i2s_pdata[2].quirks |= DW_I2S_QUIRK_16BIT_IDX_OVERRIDE;
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
|
|
i2s_pdata[2].cap = DWC_I2S_PLAY | DWC_I2S_RECORD;
|
|
i2s_pdata[2].snd_rates = SNDRV_PCM_RATE_8000_96000;
|
|
i2s_pdata[2].i2s_reg_comp1 = ACP_BT_COMP1_REG_OFFSET;
|
|
i2s_pdata[2].i2s_reg_comp2 = ACP_BT_COMP2_REG_OFFSET;
|
|
|
|
adev->acp.acp_res[0].name = "acp2x_dma";
|
|
adev->acp.acp_res[0].flags = IORESOURCE_MEM;
|
|
adev->acp.acp_res[0].start = acp_base;
|
|
adev->acp.acp_res[0].end = acp_base + ACP_DMA_REGS_END;
|
|
|
|
adev->acp.acp_res[1].name = "acp2x_dw_i2s_play";
|
|
adev->acp.acp_res[1].flags = IORESOURCE_MEM;
|
|
adev->acp.acp_res[1].start = acp_base + ACP_I2S_PLAY_REGS_START;
|
|
adev->acp.acp_res[1].end = acp_base + ACP_I2S_PLAY_REGS_END;
|
|
|
|
adev->acp.acp_res[2].name = "acp2x_dw_i2s_cap";
|
|
adev->acp.acp_res[2].flags = IORESOURCE_MEM;
|
|
adev->acp.acp_res[2].start = acp_base + ACP_I2S_CAP_REGS_START;
|
|
adev->acp.acp_res[2].end = acp_base + ACP_I2S_CAP_REGS_END;
|
|
|
|
adev->acp.acp_res[3].name = "acp2x_dw_bt_i2s_play_cap";
|
|
adev->acp.acp_res[3].flags = IORESOURCE_MEM;
|
|
adev->acp.acp_res[3].start = acp_base + ACP_BT_PLAY_REGS_START;
|
|
adev->acp.acp_res[3].end = acp_base + ACP_BT_PLAY_REGS_END;
|
|
|
|
adev->acp.acp_res[4].name = "acp2x_dma_irq";
|
|
adev->acp.acp_res[4].flags = IORESOURCE_IRQ;
|
|
adev->acp.acp_res[4].start = amdgpu_irq_create_mapping(adev, 162);
|
|
adev->acp.acp_res[4].end = adev->acp.acp_res[4].start;
|
|
|
|
adev->acp.acp_cell[0].name = "acp_audio_dma";
|
|
adev->acp.acp_cell[0].num_resources = 5;
|
|
adev->acp.acp_cell[0].resources = &adev->acp.acp_res[0];
|
|
adev->acp.acp_cell[0].platform_data = &adev->asic_type;
|
|
adev->acp.acp_cell[0].pdata_size = sizeof(adev->asic_type);
|
|
|
|
adev->acp.acp_cell[1].name = "designware-i2s";
|
|
adev->acp.acp_cell[1].num_resources = 1;
|
|
adev->acp.acp_cell[1].resources = &adev->acp.acp_res[1];
|
|
adev->acp.acp_cell[1].platform_data = &i2s_pdata[0];
|
|
adev->acp.acp_cell[1].pdata_size = sizeof(struct i2s_platform_data);
|
|
|
|
adev->acp.acp_cell[2].name = "designware-i2s";
|
|
adev->acp.acp_cell[2].num_resources = 1;
|
|
adev->acp.acp_cell[2].resources = &adev->acp.acp_res[2];
|
|
adev->acp.acp_cell[2].platform_data = &i2s_pdata[1];
|
|
adev->acp.acp_cell[2].pdata_size = sizeof(struct i2s_platform_data);
|
|
|
|
adev->acp.acp_cell[3].name = "designware-i2s";
|
|
adev->acp.acp_cell[3].num_resources = 1;
|
|
adev->acp.acp_cell[3].resources = &adev->acp.acp_res[3];
|
|
adev->acp.acp_cell[3].platform_data = &i2s_pdata[2];
|
|
adev->acp.acp_cell[3].pdata_size = sizeof(struct i2s_platform_data);
|
|
|
|
r = mfd_add_hotplug_devices(adev->acp.parent, adev->acp.acp_cell, ACP_DEVS);
|
|
if (r)
|
|
goto failure;
|
|
|
|
r = device_for_each_child(adev->acp.parent, &adev->acp.acp_genpd->gpd,
|
|
acp_genpd_add_device);
|
|
if (r)
|
|
goto failure;
|
|
}
|
|
|
|
/* Assert Soft reset of ACP */
|
|
val = cgs_read_register(adev->acp.cgs_device, mmACP_SOFT_RESET);
|
|
|
|
val |= ACP_SOFT_RESET__SoftResetAud_MASK;
|
|
cgs_write_register(adev->acp.cgs_device, mmACP_SOFT_RESET, val);
|
|
|
|
count = ACP_SOFT_RESET_DONE_TIME_OUT_VALUE;
|
|
while (true) {
|
|
val = cgs_read_register(adev->acp.cgs_device, mmACP_SOFT_RESET);
|
|
if (ACP_SOFT_RESET__SoftResetAudDone_MASK ==
|
|
(val & ACP_SOFT_RESET__SoftResetAudDone_MASK))
|
|
break;
|
|
if (--count == 0) {
|
|
dev_err(&adev->pdev->dev, "Failed to reset ACP\n");
|
|
r = -ETIMEDOUT;
|
|
goto failure;
|
|
}
|
|
udelay(100);
|
|
}
|
|
/* Enable clock to ACP and wait until the clock is enabled */
|
|
val = cgs_read_register(adev->acp.cgs_device, mmACP_CONTROL);
|
|
val = val | ACP_CONTROL__ClkEn_MASK;
|
|
cgs_write_register(adev->acp.cgs_device, mmACP_CONTROL, val);
|
|
|
|
count = ACP_CLOCK_EN_TIME_OUT_VALUE;
|
|
|
|
while (true) {
|
|
val = cgs_read_register(adev->acp.cgs_device, mmACP_STATUS);
|
|
if (val & (u32) 0x1)
|
|
break;
|
|
if (--count == 0) {
|
|
dev_err(&adev->pdev->dev, "Failed to reset ACP\n");
|
|
r = -ETIMEDOUT;
|
|
goto failure;
|
|
}
|
|
udelay(100);
|
|
}
|
|
/* Deassert the SOFT RESET flags */
|
|
val = cgs_read_register(adev->acp.cgs_device, mmACP_SOFT_RESET);
|
|
val &= ~ACP_SOFT_RESET__SoftResetAud_MASK;
|
|
cgs_write_register(adev->acp.cgs_device, mmACP_SOFT_RESET, val);
|
|
return 0;
|
|
|
|
failure:
|
|
kfree(i2s_pdata);
|
|
kfree(adev->acp.acp_res);
|
|
kfree(adev->acp.acp_cell);
|
|
kfree(adev->acp.acp_genpd);
|
|
return r;
|
|
}
|
|
|
|
/**
|
|
* acp_hw_fini - stop the hardware block
|
|
*
|
|
* @handle: handle used to pass amdgpu_device pointer
|
|
*
|
|
*/
|
|
static int acp_hw_fini(void *handle)
|
|
{
|
|
u32 val = 0;
|
|
u32 count = 0;
|
|
struct amdgpu_device *adev = (struct amdgpu_device *)handle;
|
|
|
|
/* return early if no ACP */
|
|
if (!adev->acp.acp_genpd) {
|
|
amdgpu_dpm_set_powergating_by_smu(adev, AMD_IP_BLOCK_TYPE_ACP, false);
|
|
return 0;
|
|
}
|
|
|
|
/* Assert Soft reset of ACP */
|
|
val = cgs_read_register(adev->acp.cgs_device, mmACP_SOFT_RESET);
|
|
|
|
val |= ACP_SOFT_RESET__SoftResetAud_MASK;
|
|
cgs_write_register(adev->acp.cgs_device, mmACP_SOFT_RESET, val);
|
|
|
|
count = ACP_SOFT_RESET_DONE_TIME_OUT_VALUE;
|
|
while (true) {
|
|
val = cgs_read_register(adev->acp.cgs_device, mmACP_SOFT_RESET);
|
|
if (ACP_SOFT_RESET__SoftResetAudDone_MASK ==
|
|
(val & ACP_SOFT_RESET__SoftResetAudDone_MASK))
|
|
break;
|
|
if (--count == 0) {
|
|
dev_err(&adev->pdev->dev, "Failed to reset ACP\n");
|
|
return -ETIMEDOUT;
|
|
}
|
|
udelay(100);
|
|
}
|
|
/* Disable ACP clock */
|
|
val = cgs_read_register(adev->acp.cgs_device, mmACP_CONTROL);
|
|
val &= ~ACP_CONTROL__ClkEn_MASK;
|
|
cgs_write_register(adev->acp.cgs_device, mmACP_CONTROL, val);
|
|
|
|
count = ACP_CLOCK_EN_TIME_OUT_VALUE;
|
|
|
|
while (true) {
|
|
val = cgs_read_register(adev->acp.cgs_device, mmACP_STATUS);
|
|
if (val & (u32) 0x1)
|
|
break;
|
|
if (--count == 0) {
|
|
dev_err(&adev->pdev->dev, "Failed to reset ACP\n");
|
|
return -ETIMEDOUT;
|
|
}
|
|
udelay(100);
|
|
}
|
|
|
|
device_for_each_child(adev->acp.parent, NULL,
|
|
acp_genpd_remove_device);
|
|
|
|
mfd_remove_devices(adev->acp.parent);
|
|
kfree(adev->acp.acp_res);
|
|
kfree(adev->acp.acp_genpd);
|
|
kfree(adev->acp.acp_cell);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int acp_suspend(void *handle)
|
|
{
|
|
struct amdgpu_device *adev = (struct amdgpu_device *)handle;
|
|
|
|
/* power up on suspend */
|
|
if (!adev->acp.acp_cell)
|
|
amdgpu_dpm_set_powergating_by_smu(adev, AMD_IP_BLOCK_TYPE_ACP, false);
|
|
return 0;
|
|
}
|
|
|
|
static int acp_resume(void *handle)
|
|
{
|
|
struct amdgpu_device *adev = (struct amdgpu_device *)handle;
|
|
|
|
/* power down again on resume */
|
|
if (!adev->acp.acp_cell)
|
|
amdgpu_dpm_set_powergating_by_smu(adev, AMD_IP_BLOCK_TYPE_ACP, true);
|
|
return 0;
|
|
}
|
|
|
|
static int acp_early_init(void *handle)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
static bool acp_is_idle(void *handle)
|
|
{
|
|
return true;
|
|
}
|
|
|
|
static int acp_wait_for_idle(void *handle)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
static int acp_soft_reset(void *handle)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
static int acp_set_clockgating_state(void *handle,
|
|
enum amd_clockgating_state state)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
static int acp_set_powergating_state(void *handle,
|
|
enum amd_powergating_state state)
|
|
{
|
|
struct amdgpu_device *adev = (struct amdgpu_device *)handle;
|
|
bool enable = (state == AMD_PG_STATE_GATE);
|
|
|
|
amdgpu_dpm_set_powergating_by_smu(adev, AMD_IP_BLOCK_TYPE_ACP, enable);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct amd_ip_funcs acp_ip_funcs = {
|
|
.name = "acp_ip",
|
|
.early_init = acp_early_init,
|
|
.late_init = NULL,
|
|
.sw_init = acp_sw_init,
|
|
.sw_fini = acp_sw_fini,
|
|
.hw_init = acp_hw_init,
|
|
.hw_fini = acp_hw_fini,
|
|
.suspend = acp_suspend,
|
|
.resume = acp_resume,
|
|
.is_idle = acp_is_idle,
|
|
.wait_for_idle = acp_wait_for_idle,
|
|
.soft_reset = acp_soft_reset,
|
|
.set_clockgating_state = acp_set_clockgating_state,
|
|
.set_powergating_state = acp_set_powergating_state,
|
|
};
|
|
|
|
const struct amdgpu_ip_block_version acp_ip_block = {
|
|
.type = AMD_IP_BLOCK_TYPE_ACP,
|
|
.major = 2,
|
|
.minor = 2,
|
|
.rev = 0,
|
|
.funcs = &acp_ip_funcs,
|
|
};
|