power: Move EC_CMD_GSV_PAUSE_IN_S5 handler to common code

The same code exists in four (soon to be five!) different power
sequencing drivers, so move it up to common.

BUG=None
TEST=Manual on Samus. Run "pause_in_s5 on" on EC console, verify that
system stops in S5 on shutdown. Run "pause_in_s5 off" on EC console,
verify that system again goes to G3 on shutdown.
BRANCH=None

Signed-off-by: Shawn Nematbakhsh <shawnn@chromium.org>
Change-Id: Iaf05ef7ce017be4f9d173e83e985a7a879ba278c
Reviewed-on: https://chromium-review.googlesource.com/269566
Reviewed-by: Randall Spangler <rspangler@chromium.org>

4 files changed, 60 insertions, 104 deletions

diff --git a/power/baytrail.c b/power/baytrail.c
index c84e74130a..3290378234 100644
--- a/power/baytrail.c
+++ b/power/baytrail.c
@@ -11,7 +11,6 @@
 #include "ec_commands.h"
 #include "gpio.h"
 #include "hooks.h"
-#include "host_command.h"
 #include "lid_switch.h"
 #include "lpc.h"
 #include "power.h"
@@ -52,7 +51,6 @@
 		   IN_PGOOD_ALL_CORE | IN_ALL_PM_SLP_DEASSERTED)
 
 static int throttle_cpu;      /* Throttle CPU? */
-static int pause_in_s5 = 1;   /* Pause in S5 when shutting down? */
 static int restart_from_s5;   /* Force system back on from S5 */
 static int fake_pltrst_timeout;  /* Fake PLTRST# timeout at next power-on */
 
@@ -110,6 +108,9 @@ void chipset_throttle_cpu(int throttle)
 
 enum power_state power_chipset_init(void)
 {
+	/* Pause in S5 when shutting down. */
+	power_set_pause_in_s5(1);
+
 	/*
 	 * If we're switching between images without rebooting, see if the x86
 	 * is already powered on; if so, leave it there instead of cycling
@@ -400,7 +401,7 @@ enum power_state power_handle_state(enum power_state state)
 		}
 
 		/* Start shutting down */
-		return pause_in_s5 ? POWER_S5 : POWER_S5G3;
+		return power_get_pause_in_s5() ? POWER_S5 : POWER_S5G3;
 
 	case POWER_S5G3:
 		/* Assert RSMRST# */
@@ -413,37 +414,6 @@ enum power_state power_handle_state(enum power_state state)
 	return state;
 }
 
-static int host_command_gsv(struct host_cmd_handler_args *args)
-{
-	const struct ec_params_get_set_value *p = args->params;
-	struct ec_response_get_set_value *r = args->response;
-
-	if (p->flags & EC_GSV_SET)
-		pause_in_s5 = p->value;
-
-	r->value = pause_in_s5;
-
-	args->response_size = sizeof(*r);
-	return EC_RES_SUCCESS;
-}
-DECLARE_HOST_COMMAND(EC_CMD_GSV_PAUSE_IN_S5,
-		     host_command_gsv,
-		     EC_VER_MASK(0));
-
-static int console_command_gsv(int argc, char **argv)
-{
-	if (argc > 1 && !parse_bool(argv[1], &pause_in_s5))
-		return EC_ERROR_INVAL;
-
-	ccprintf("pause_in_s5 = %s\n", pause_in_s5 ? "on" : "off");
-
-	return EC_SUCCESS;
-}
-DECLARE_CONSOLE_COMMAND(pause_in_s5, console_command_gsv,
-			"[on|off]",
-			"Should the AP pause in S5 during shutdown?",
-			NULL);
-
 static int console_command_powerfail(int argc, char **argv)
 {
 	ccprintf("Faking a failure of next power-on event\n");
diff --git a/power/braswell.c b/power/braswell.c
index 0e2adb1034..aa9301f5d8 100644
--- a/power/braswell.c
+++ b/power/braswell.c
@@ -11,7 +11,6 @@
 #include "ec_commands.h"
 #include "gpio.h"
 #include "hooks.h"
-#include "host_command.h"
 #include "lid_switch.h"
 #include "lpc.h"
 #include "power.h"
@@ -52,7 +51,6 @@
 #define IN_ALL_S0 (IN_PGOOD_S0 | IN_ALL_PM_SLP_DEASSERTED)
 
 static int throttle_cpu;      /* Throttle CPU? */
-static int pause_in_s5 = 1;   /* Pause in S5 when shutting down? */
 
 void chipset_force_shutdown(void)
 {
@@ -108,6 +106,9 @@ void chipset_throttle_cpu(int throttle)
 
 enum power_state power_chipset_init(void)
 {
+	/* Pause in S5 when shutting down. */
+	power_set_pause_in_s5(1);
+
 	/*
 	 * If we're switching between images without rebooting, see if the x86
 	 * is already powered on; if so, leave it there instead of cycling
@@ -292,7 +293,7 @@ enum power_state power_handle_state(enum power_state state)
 		/*wireless_set_state(WIRELESS_OFF);*/
 
 		/* Start shutting down */
-		return pause_in_s5 ? POWER_S5 : POWER_S5G3;
+		return power_get_pause_in_s5() ? POWER_S5 : POWER_S5G3;
 
 	case POWER_S5G3:
 		/* Assert RSMRST# */
@@ -302,34 +303,3 @@ enum power_state power_handle_state(enum power_state state)
 
 	return state;
 }
-
-static int host_command_gsv(struct host_cmd_handler_args *args)
-{
-	const struct ec_params_get_set_value *p = args->params;
-	struct ec_response_get_set_value *r = args->response;
-
-	if (p->flags & EC_GSV_SET)
-		pause_in_s5 = p->value;
-
-	r->value = pause_in_s5;
-
-	args->response_size = sizeof(*r);
-	return EC_RES_SUCCESS;
-}
-DECLARE_HOST_COMMAND(EC_CMD_GSV_PAUSE_IN_S5,
-		     host_command_gsv,
-		     EC_VER_MASK(0));
-
-static int console_command_gsv(int argc, char **argv)
-{
-	if (argc > 1 && !parse_bool(argv[1], &pause_in_s5))
-		return EC_ERROR_INVAL;
-
-	ccprintf("pause_in_s5 = %s\n", pause_in_s5 ? "on" : "off");
-
-	return EC_SUCCESS;
-}
-DECLARE_CONSOLE_COMMAND(pause_in_s5, console_command_gsv,
-			"[on|off]",
-			"Should the AP pause in S5 during shutdown?",
-			NULL);
diff --git a/power/common.c b/power/common.c
index b1bced365d..f59fe45273 100644
--- a/power/common.c
+++ b/power/common.c
@@ -12,6 +12,7 @@
 #include "extpower.h"
 #include "gpio.h"
 #include "hooks.h"
+#include "host_command.h"
 #include "power.h"
 #include "system.h"
 #include "task.h"
@@ -58,6 +59,11 @@ static uint64_t last_shutdown_time; /* When did we enter G3? */
 static uint32_t hibernate_delay = CONFIG_HIBERNATE_DELAY_SEC;
 #endif
 
+#ifdef CONFIG_POWER_SHUTDOWN_PAUSE_IN_S5
+/* Pause in S5 on shutdown? */
+static int pause_in_s5;
+#endif
+
 /**
  * Update input signals mask
  */
@@ -410,7 +416,6 @@ static void siglog_add(enum gpio_signal signal)
 #define SIGLOG(S)
 #endif	/* CONFIG_BRINGUP */
 
-
 void power_signal_interrupt(enum gpio_signal signal)
 {
 	SIGLOG(signal);
@@ -422,6 +427,18 @@ void power_signal_interrupt(enum gpio_signal signal)
 	task_wake(TASK_ID_CHIPSET);
 }
 
+#ifdef CONFIG_POWER_SHUTDOWN_PAUSE_IN_S5
+inline int power_get_pause_in_s5(void)
+{
+	return pause_in_s5;
+}
+
+inline void power_set_pause_in_s5(int pause)
+{
+	pause_in_s5 = pause;
+}
+#endif
+
 /*****************************************************************************/
 /* Console commands */
 
@@ -506,3 +523,36 @@ DECLARE_CONSOLE_COMMAND(hibdelay, command_hibernation_delay,
 			"Set the delay before going into hibernation",
 			NULL);
 #endif /* CONFIG_HIBERNATE */
+
+#ifdef CONFIG_POWER_SHUTDOWN_PAUSE_IN_S5
+static int host_command_pause_in_s5(struct host_cmd_handler_args *args)
+{
+	const struct ec_params_get_set_value *p = args->params;
+	struct ec_response_get_set_value *r = args->response;
+
+	if (p->flags & EC_GSV_SET)
+		pause_in_s5 = p->value;
+
+	r->value = pause_in_s5;
+
+	args->response_size = sizeof(*r);
+	return EC_RES_SUCCESS;
+}
+DECLARE_HOST_COMMAND(EC_CMD_GSV_PAUSE_IN_S5,
+		     host_command_pause_in_s5,
+		     EC_VER_MASK(0));
+
+static int command_pause_in_s5(int argc, char **argv)
+{
+	if (argc > 1 && !parse_bool(argv[1], &pause_in_s5))
+		return EC_ERROR_INVAL;
+
+	ccprintf("pause_in_s5 = %s\n", pause_in_s5 ? "on" : "off");
+
+	return EC_SUCCESS;
+}
+DECLARE_CONSOLE_COMMAND(pause_in_s5, command_pause_in_s5,
+			"[on|off]",
+			"Should the AP pause in S5 during shutdown?",
+			NULL);
+#endif /* CONFIG_POWER_SHUTDOWN_PAUSE_IN_S5 */
diff --git a/power/haswell.c b/power/haswell.c
index ae7cf7a14a..00a0926f6e 100644
--- a/power/haswell.c
+++ b/power/haswell.c
@@ -11,7 +11,6 @@
 #include "ec_commands.h"
 #include "gpio.h"
 #include "hooks.h"
-#include "host_command.h"
 #include "lid_switch.h"
 #include "power.h"
 #include "system.h"
@@ -52,7 +51,6 @@
 		   IN_PGOOD_ALL_CORE | IN_ALL_PM_SLP_DEASSERTED)
 
 static int throttle_cpu;      /* Throttle CPU? */
-static int pause_in_s5;	      /* Pause in S5 when shutting down? */
 
 void chipset_force_shutdown(void)
 {
@@ -360,7 +358,7 @@ enum power_state power_handle_state(enum power_state state)
 		gpio_set_level(GPIO_PP5000_EN, 0);
 
 		/* Start shutting down */
-		return pause_in_s5 ? POWER_S5 : POWER_S5G3;
+		return power_get_pause_in_s5() ? POWER_S5 : POWER_S5G3;
 
 	case POWER_S5G3:
 		/* Deassert DPWROK, assert RSMRST# */
@@ -378,35 +376,3 @@ void power_interrupt(enum gpio_signal signal)
 	/* Pass through eDP VDD enable from PCH */
 	gpio_set_level(GPIO_EC_EDP_VDD_EN, gpio_get_level(GPIO_PCH_EDP_VDD_EN));
 }
-
-static int host_command_gsv(struct host_cmd_handler_args *args)
-{
-	const struct ec_params_get_set_value *p = args->params;
-	struct ec_response_get_set_value *r = args->response;
-
-	if (p->flags & EC_GSV_SET)
-		pause_in_s5 = p->value;
-
-	r->value = pause_in_s5;
-
-	args->response_size = sizeof(*r);
-	return EC_RES_SUCCESS;
-}
-DECLARE_HOST_COMMAND(EC_CMD_GSV_PAUSE_IN_S5,
-		     host_command_gsv,
-		     EC_VER_MASK(0));
-
-static int console_command_gsv(int argc, char **argv)
-{
-	if (argc > 1 && !parse_bool(argv[1], &pause_in_s5))
-		return EC_ERROR_INVAL;
-
-	ccprintf("pause_in_s5 = %s\n", pause_in_s5 ? "on" : "off");
-
-	return EC_SUCCESS;
-}
-DECLARE_CONSOLE_COMMAND(pause_in_s5, console_command_gsv,
-			"[on|off]",
-			"Should the AP pause in S5 during shutdown?",
-			NULL);
-