shinys000114/linux
1
0
Fork 0
mirror of https://github.com/hardkernel/linux.git synced 2026-06-05 10:31:46 +09:00
Code Issues Packages Projects Releases Wiki Activity

mfd: rockchip-flexbus: Add resume

Browse Source 
Add resume for rockchip-flexbus.

Change-Id: I2a87064e4267839f2daccbcc2e28b9d5786bf6f4
Signed-off-by: Wesley Yao <wesley.yao@rock-chips.com>
This commit is contained in:
Wesley Yao
2025-03-18 10:32:09 +08:00
committed by Tao Huang
parent a26e159e16
commit ba1c3b949b
1 changed files with 27 additions and 10 deletions
Download Patch File Download Diff File Expand all files Collapse all files

37
drivers/mfd/rockchip-flexbus.c
View File

@@ -138,6 +138,20 @@ static void rockchip_flexbus_clk_bulk_disable(void *data)
clk_bulk_disable_unprepare(rkfb->num_clks, rkfb->clks);
}
static void rockchip_flexbus_init(struct rockchip_flexbus *rkfb)
{
if (rkfb->config->init_config)
rkfb->config->init_config(rkfb);
if (rkfb->opmode0 != ROCKCHIP_FLEXBUS0_OPMODE_NULL &&
rkfb->opmode1 != ROCKCHIP_FLEXBUS1_OPMODE_NULL)
rockchip_flexbus_writel(rkfb, FLEXBUS_COM_CTL, FLEXBUS_TX_AND_RX);
else if (rkfb->opmode0 != ROCKCHIP_FLEXBUS0_OPMODE_NULL)
rockchip_flexbus_writel(rkfb, FLEXBUS_COM_CTL, FLEXBUS_TX_ONLY);
else
rockchip_flexbus_writel(rkfb, FLEXBUS_COM_CTL, FLEXBUS_RX_ONLY);
}
static int rockchip_flexbus_probe(struct platform_device *pdev)
{
struct rockchip_flexbus *rkfb;
@@ -205,16 +219,7 @@ static int rockchip_flexbus_probe(struct platform_device *pdev)
return ret;
}
if (rkfb->config->init_config)
rkfb->config->init_config(rkfb);
if (rkfb->opmode0 != ROCKCHIP_FLEXBUS0_OPMODE_NULL &&
rkfb->opmode1 != ROCKCHIP_FLEXBUS1_OPMODE_NULL)
rockchip_flexbus_writel(rkfb, FLEXBUS_COM_CTL, FLEXBUS_TX_AND_RX);
else if (rkfb->opmode0 != ROCKCHIP_FLEXBUS0_OPMODE_NULL)
rockchip_flexbus_writel(rkfb, FLEXBUS_COM_CTL, FLEXBUS_TX_ONLY);
else
rockchip_flexbus_writel(rkfb, FLEXBUS_COM_CTL, FLEXBUS_RX_ONLY);
rockchip_flexbus_init(rkfb);
switch (rockchip_flexbus_readl(rkfb, FLEXBUS_REVISION) >> 24 & 0xff) {
case 0x0:
@@ -250,11 +255,23 @@ static const struct of_device_id rockchip_flexbus_of_match[] = {
};
MODULE_DEVICE_TABLE(of, rockchip_flexbus_of_match);
static int rockchip_flexbus_resume(struct device *dev)
{
struct rockchip_flexbus *rkfb = dev_get_drvdata(dev);
rockchip_flexbus_init(rkfb);
return 0;
}
static DEFINE_SIMPLE_DEV_PM_OPS(rockchip_flexbus_pm_ops, NULL, rockchip_flexbus_resume);
static struct platform_driver rockchip_flexbus_driver = {
.probe = rockchip_flexbus_probe,
.driver = {
.name = "rockchip_flexbus",
.of_match_table = rockchip_flexbus_of_match,
.pm = pm_sleep_ptr(&rockchip_flexbus_pm_ops),
},
};