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

i2c: rk3x: adjust the divisor after mcu is done for thunder-boot

Browse Source 
Signed-off-by: Ziyuan Xu <xzy.xu@rock-chips.com>
Change-Id: If83590a7d0e30d611837f82df8f9b7ea09907c6d
This commit is contained in:
Ziyuan Xu
2022-12-09 15:42:19 +08:00
committed by Tao Huang
parent 2edabfb256
commit fba2070492
1 changed files with 40 additions and 18 deletions
Download Patch File Download Diff File Expand all files Collapse all files

58
drivers/i2c/busses/i2c-rk3x.c
View File

@@ -248,6 +248,7 @@ struct rk3x_i2c {
struct notifier_block i2c_restart_nb;
bool system_restarting;
struct rk_tb_client tb_cl;
int irq;
};
static void rk3x_i2c_prepare_read(struct rk3x_i2c *i2c);
@@ -1468,9 +1469,28 @@ MODULE_DEVICE_TABLE(of, rk3x_i2c_match);
static void rk3x_i2c_tb_cb(void *data)
{
unsigned int irq = (unsigned long)data;
unsigned long clk_rate;
int ret;
struct rk3x_i2c *i2c = (struct rk3x_i2c *)data;
enable_irq(irq);
if (i2c->clk) {
i2c->clk_rate_nb.notifier_call = rk3x_i2c_clk_notifier_cb;
ret = clk_notifier_register(i2c->clk, &i2c->clk_rate_nb);
if (ret != 0) {
dev_err(i2c->dev, "Unable to register clock notifier\n");
clk_unprepare(i2c->pclk);
clk_unprepare(i2c->clk);
return;
}
}
clk_rate = clk_get_rate(i2c->clk);
if (!clk_rate)
device_property_read_u32(i2c->dev, "i2c,clk-rate", (u32 *)&clk_rate);
rk3x_i2c_adapt_div(i2c, clk_rate);
enable_irq(i2c->irq);
}
static int rk3x_i2c_probe(struct platform_device *pdev)
@@ -1563,10 +1583,11 @@ static int rk3x_i2c_probe(struct platform_device *pdev)
irq = platform_get_irq(pdev, 0);
if (irq < 0)
return irq;
i2c->irq = irq;
if (IS_ENABLED(CONFIG_ROCKCHIP_THUNDER_BOOT_SERVICE) &&
device_property_read_bool(&pdev->dev, "rockchip,amp-shared")) {
i2c->tb_cl.data = (void *)(unsigned long)irq;
i2c->tb_cl.data = i2c;
i2c->tb_cl.cb = rk3x_i2c_tb_cb;
irq_set_status_flags(irq, IRQ_NOAUTOEN);
}
@@ -1578,9 +1599,6 @@ static int rk3x_i2c_probe(struct platform_device *pdev)
return ret;
}
if (IS_ENABLED(CONFIG_ROCKCHIP_THUNDER_BOOT_SERVICE) && i2c->tb_cl.cb)
rk_tb_client_register_cb(&i2c->tb_cl);
platform_set_drvdata(pdev, i2c);
if (!has_acpi_companion(&pdev->dev)) {
@@ -1613,21 +1631,25 @@ static int rk3x_i2c_probe(struct platform_device *pdev)
goto err_clk;
}
if (i2c->clk) {
i2c->clk_rate_nb.notifier_call = rk3x_i2c_clk_notifier_cb;
ret = clk_notifier_register(i2c->clk, &i2c->clk_rate_nb);
if (ret != 0) {
dev_err(&pdev->dev, "Unable to register clock notifier\n");
goto err_pclk;
if (IS_ENABLED(CONFIG_ROCKCHIP_THUNDER_BOOT_SERVICE) && i2c->tb_cl.cb) {
rk_tb_client_register_cb(&i2c->tb_cl);
} else {
if (i2c->clk) {
i2c->clk_rate_nb.notifier_call = rk3x_i2c_clk_notifier_cb;
ret = clk_notifier_register(i2c->clk, &i2c->clk_rate_nb);
if (ret != 0) {
dev_err(&pdev->dev, "Unable to register clock notifier\n");
goto err_pclk;
}
}
clk_rate = clk_get_rate(i2c->clk);
if (!clk_rate)
device_property_read_u32(&pdev->dev, "i2c,clk-rate", (u32 *)&clk_rate);
rk3x_i2c_adapt_div(i2c, clk_rate);
}
clk_rate = clk_get_rate(i2c->clk);
if (!clk_rate)
device_property_read_u32(&pdev->dev, "i2c,clk-rate", (u32 *)&clk_rate);
rk3x_i2c_adapt_div(i2c, clk_rate);
if (rk3x_i2c_get_version(i2c) >= RK_I2C_VERSION5)
i2c->autostop_supported = true;