From: Jianhong Chen <chenjh@rock-chips.com>
Date: Mon, 19 Dec 2016 06:37:53 +0000 (+0800)
Subject: power: rk818-charger: set sleep otg 5v by otg_in status and dts
X-Git-Tag: firefly_0821_release~660
X-Git-Url: http://plrg.eecs.uci.edu/git/?p=firefly-linux-kernel-4.4.55.git;a=commitdiff_plain;h=7ba1220f6bbb7f706aa07c155c7de15980aa85de

power: rk818-charger: set sleep otg 5v by otg_in status and dts

Change-Id: I1b2c14dfa64fe382e05717c5e9bb6a5617badba0
Signed-off-by: Jianhong Chen <chenjh@rock-chips.com>
---

diff --git a/drivers/power/rk818_charger.c b/drivers/power/rk818_charger.c
index 425edd27c842..538952e61d54 100644
--- a/drivers/power/rk818_charger.c
+++ b/drivers/power/rk818_charger.c
@@ -113,6 +113,7 @@ struct charger_platform_data {
 	bool support_dc_det;
 	int virtual_power;
 	int sample_res;
+	int otg5v_suspend_enable;
 	bool extcon;
 };
 
@@ -150,6 +151,7 @@ struct rk818_charger {
 	u8 chrg_input;
 	u8 chrg_current;
 	u8 res_div;
+	u8 sleep_set_off_reg1;
 	u8 plugin_trigger;
 	u8 plugout_trigger;
 	int plugin_irq;
@@ -1174,6 +1176,13 @@ static int rk818_cg_parse_dt(struct rk818_charger *cg)
 		dev_err(dev, "sample_res missing!\n");
 	}
 
+	ret = of_property_read_u32(np, "otg5v_suspend_enable",
+				   &pdata->otg5v_suspend_enable);
+	if (ret < 0) {
+		pdata->otg5v_suspend_enable = 1;
+		dev_err(dev, "otg5v_suspend_enable missing!\n");
+	}
+
 	if (!is_battery_exist(cg))
 		pdata->virtual_power = 1;
 
@@ -1306,8 +1315,47 @@ static void rk818_charger_shutdown(struct platform_device *pdev)
 		cg->ac_in, cg->usb_in, cg->dc_in, cg->otg_in);
 }
 
+static int rk818_charger_suspend(struct platform_device *pdev,
+				 pm_message_t state)
+{
+	struct rk818_charger *cg = platform_get_drvdata(pdev);
+
+	cg->sleep_set_off_reg1 = rk818_reg_read(cg, RK818_SLEEP_SET_OFF_REG1);
+
+	/* enable sleep boost5v and otg5v */
+	if (cg->pdata->otg5v_suspend_enable) {
+		if ((cg->otg_in && !cg->dc_in) ||
+		    (cg->otg_in && cg->dc_in && !cg->pdata->power_dc2otg)) {
+			rk818_reg_clear_bits(cg, RK818_SLEEP_SET_OFF_REG1,
+					     OTG_BOOST_SLP_OFF);
+			CG_INFO("suspend: otg 5v on\n");
+			return 0;
+		}
+	}
+
+	/* disable sleep otg5v */
+	rk818_reg_set_bits(cg, RK818_SLEEP_SET_OFF_REG1,
+			   OTG_SLP_SET_OFF, OTG_SLP_SET_OFF);
+	CG_INFO("suspend: otg 5v off\n");
+
+	return 0;
+}
+
+static int rk818_charger_resume(struct platform_device *pdev)
+{
+	struct rk818_charger *cg = platform_get_drvdata(pdev);
+
+	/* resume sleep boost5v and otg5v */
+	rk818_reg_set_bits(cg, RK818_SLEEP_SET_OFF_REG1,
+			   OTG_BOOST_SLP_OFF, cg->sleep_set_off_reg1);
+
+	return 0;
+}
+
 static struct platform_driver rk818_charger_driver = {
 	.probe = rk818_charger_probe,
+	.suspend = rk818_charger_suspend,
+	.resume = rk818_charger_resume,
 	.shutdown = rk818_charger_shutdown,
 	.driver = {
 		.name	= "rk818-charger",
diff --git a/include/linux/mfd/rk808.h b/include/linux/mfd/rk808.h
index 59aa1eeb2845..e1bbc26dce84 100644
--- a/include/linux/mfd/rk808.h
+++ b/include/linux/mfd/rk808.h
@@ -389,6 +389,7 @@ enum rk805_reg {
 #define LDO9_SLP_SET_OFF	BIT(5)
 #define SWITCH_SLP_SET_OFF	BIT(6)
 #define OTG_SLP_SET_OFF		BIT(7)
+#define OTG_BOOST_SLP_OFF	(BOOST_SLP_SET_OFF | OTG_SLP_SET_OFF)
 
 #define BUCK1_SLP_SET_ON	BIT(0)
 #define BUCK2_SLP_SET_ON	BIT(1)