150 lines
4.1 KiB
Diff
150 lines
4.1 KiB
Diff
From 352ee5af6d5f75573b1dab6e7d2ff1887a48363e Mon Sep 17 00:00:00 2001
|
|
From: Samuel Holland <samuel@sholland.org>
|
|
Date: Wed, 12 Feb 2020 22:58:30 -0600
|
|
Subject: [PATCH 164/351] i2c: mv64xxx: Add runtime PM support
|
|
|
|
Signed-off-by: Samuel Holland <samuel@sholland.org>
|
|
---
|
|
drivers/i2c/busses/i2c-mv64xxx.c | 67 ++++++++++++++++++++++++++------
|
|
1 file changed, 56 insertions(+), 11 deletions(-)
|
|
|
|
diff --git a/drivers/i2c/busses/i2c-mv64xxx.c b/drivers/i2c/busses/i2c-mv64xxx.c
|
|
index e0e45fc19b8f..2f44eeaf7c13 100644
|
|
--- a/drivers/i2c/busses/i2c-mv64xxx.c
|
|
+++ b/drivers/i2c/busses/i2c-mv64xxx.c
|
|
@@ -17,6 +17,7 @@
|
|
#include <linux/interrupt.h>
|
|
#include <linux/mv643xx_i2c.h>
|
|
#include <linux/platform_device.h>
|
|
+#include <linux/pm_runtime.h>
|
|
#include <linux/reset.h>
|
|
#include <linux/io.h>
|
|
#include <linux/of.h>
|
|
@@ -147,6 +148,7 @@ struct mv64xxx_i2c_data {
|
|
bool irq_clear_inverted;
|
|
/* Clk div is 2 to the power n, not 2 to the power n + 1 */
|
|
bool clk_n_base_0;
|
|
+ bool needs_init;
|
|
};
|
|
|
|
static struct mv64xxx_i2c_regs mv64xxx_i2c_regs_mv64xxx = {
|
|
@@ -713,6 +715,10 @@ mv64xxx_i2c_xfer(struct i2c_adapter *adap, struct i2c_msg msgs[], int num)
|
|
struct mv64xxx_i2c_data *drv_data = i2c_get_adapdata(adap);
|
|
int rc, ret = num;
|
|
|
|
+ rc = pm_runtime_get_sync(&adap->dev);
|
|
+ if (rc < 0)
|
|
+ return rc;
|
|
+
|
|
BUG_ON(drv_data->msgs != NULL);
|
|
drv_data->msgs = msgs;
|
|
drv_data->num_msgs = num;
|
|
@@ -728,6 +734,9 @@ mv64xxx_i2c_xfer(struct i2c_adapter *adap, struct i2c_msg msgs[], int num)
|
|
drv_data->num_msgs = 0;
|
|
drv_data->msgs = NULL;
|
|
|
|
+ pm_runtime_mark_last_busy(&adap->dev);
|
|
+ pm_runtime_put_autosuspend(&adap->dev);
|
|
+
|
|
return ret;
|
|
}
|
|
|
|
@@ -950,6 +959,11 @@ mv64xxx_i2c_probe(struct platform_device *pd)
|
|
goto exit_free_irq;
|
|
}
|
|
|
|
+ pm_runtime_set_active(&pd->dev);
|
|
+ pm_runtime_set_autosuspend_delay(&pd->dev, 1000);
|
|
+ pm_runtime_use_autosuspend(&pd->dev);
|
|
+ pm_runtime_enable(&pd->dev);
|
|
+
|
|
return 0;
|
|
|
|
exit_free_irq:
|
|
@@ -968,40 +982,71 @@ mv64xxx_i2c_remove(struct platform_device *dev)
|
|
{
|
|
struct mv64xxx_i2c_data *drv_data = platform_get_drvdata(dev);
|
|
|
|
+ pm_runtime_get_sync(&dev->dev);
|
|
+
|
|
i2c_del_adapter(&drv_data->adapter);
|
|
free_irq(drv_data->irq, drv_data);
|
|
reset_control_assert(drv_data->rstc);
|
|
clk_disable_unprepare(drv_data->reg_clk);
|
|
clk_disable_unprepare(drv_data->clk);
|
|
|
|
+ pm_runtime_put_noidle(&dev->dev);
|
|
+ pm_runtime_disable(&dev->dev);
|
|
+
|
|
return 0;
|
|
}
|
|
|
|
-#ifdef CONFIG_PM
|
|
-static int mv64xxx_i2c_resume(struct device *dev)
|
|
+static int __maybe_unused mv64xxx_i2c_runtime_suspend(struct device *dev)
|
|
{
|
|
struct mv64xxx_i2c_data *drv_data = dev_get_drvdata(dev);
|
|
|
|
- mv64xxx_i2c_hw_init(drv_data);
|
|
+ clk_disable_unprepare(drv_data->reg_clk);
|
|
+ clk_disable_unprepare(drv_data->clk);
|
|
|
|
return 0;
|
|
}
|
|
|
|
-static const struct dev_pm_ops mv64xxx_i2c_pm = {
|
|
- .resume = mv64xxx_i2c_resume,
|
|
-};
|
|
+static int __maybe_unused mv64xxx_i2c_runtime_resume(struct device *dev)
|
|
+{
|
|
+ struct mv64xxx_i2c_data *drv_data = dev_get_drvdata(dev);
|
|
|
|
-#define mv64xxx_i2c_pm_ops (&mv64xxx_i2c_pm)
|
|
-#else
|
|
-#define mv64xxx_i2c_pm_ops NULL
|
|
-#endif
|
|
+ if (!IS_ERR(drv_data->clk))
|
|
+ clk_prepare_enable(drv_data->clk);
|
|
+ if (!IS_ERR(drv_data->reg_clk))
|
|
+ clk_prepare_enable(drv_data->reg_clk);
|
|
+
|
|
+ if (drv_data->needs_init) {
|
|
+ drv_data->needs_init = false;
|
|
+ reset_control_deassert(drv_data->rstc);
|
|
+ mv64xxx_i2c_hw_init(drv_data);
|
|
+ }
|
|
+
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static int __maybe_unused mv64xxx_i2c_suspend(struct device *dev)
|
|
+{
|
|
+ struct mv64xxx_i2c_data *drv_data = dev_get_drvdata(dev);
|
|
+
|
|
+ drv_data->needs_init = true;
|
|
+ reset_control_assert(drv_data->rstc);
|
|
+
|
|
+ return pm_runtime_force_suspend(dev);
|
|
+}
|
|
+
|
|
+static const struct dev_pm_ops mv64xxx_i2c_pm_ops = {
|
|
+ SET_RUNTIME_PM_OPS(mv64xxx_i2c_runtime_suspend,
|
|
+ mv64xxx_i2c_runtime_resume, NULL)
|
|
+ SET_NOIRQ_SYSTEM_SLEEP_PM_OPS(mv64xxx_i2c_suspend,
|
|
+ pm_runtime_force_resume)
|
|
+};
|
|
|
|
static struct platform_driver mv64xxx_i2c_driver = {
|
|
.probe = mv64xxx_i2c_probe,
|
|
.remove = mv64xxx_i2c_remove,
|
|
.driver = {
|
|
.name = MV64XXX_I2C_CTLR_NAME,
|
|
- .pm = mv64xxx_i2c_pm_ops,
|
|
+ .pm = &mv64xxx_i2c_pm_ops,
|
|
.of_match_table = mv64xxx_i2c_of_match_table,
|
|
},
|
|
};
|
|
--
|
|
2.34.0
|
|
|