Lotus: add the host command to control the input module detect mode

Signed-off-by: Josh-Tsai <josh_tsai@compal.com>

Author: Josh-Tsai

zephyr/program/lotus/include/board_host_command.h

@@ -244,6 +244,10 @@ struct ec_response_chassis_counter {
  */
 #define EC_CMD_CHECK_DECK_STATE		0x3E16
 
+struct ec_params_deck_state {
+	uint8_t mode;
+} __ec_align1;
+
 struct ec_response_deck_state {
 	uint8_t input_deck_board_id[8];
 	uint8_t deck_state;

zephyr/program/lotus/include/lotus/input_module.h

@@ -50,4 +50,8 @@ int get_deck_state(void);
 
 void input_modules_powerdown(void);
 
+void set_detect_mode(int mode);
+
+int get_detect_mode(void);
+
 #endif /*__BOARD_INPUT_MODULE_H__*/

zephyr/program/lotus/lotus/src/input_module.c

@@ -28,6 +28,7 @@ LOG_MODULE_REGISTER(inputmodule, LOG_LEVEL_INF);
 
 int oc_count;
 int force_on;
+int detect_mode;
 int hub_board_id[8];	/* EC console Debug use */
 enum input_deck_state deck_state;
 
@@ -36,6 +37,17 @@ void module_oc_interrupt(enum gpio_signal signal)
     oc_count++;
 }
 
+void set_detect_mode(int mode)
+{
+	detect_mode = mode;
+}
+
+int get_detect_mode(void)
+{
+	return detect_mode;
+}
+
+
 static void set_hub_mux(uint8_t input)
 {
 	gpio_pin_set_dt(GPIO_DT_FROM_NODELABEL(gpio_mux_a0),
@@ -72,9 +84,15 @@ static void scan_c_deck(bool full_scan)
 
 static void board_input_module_init(void)
 {
-	deck_state = DECK_OFF;
+	/* need to wait bios_function_init() to update detect mode */
+	if (detect_mode == 0x02)
+		deck_state = DECK_FORCE_ON;
+	else if (detect_mode == 0x04)
+		deck_state = DECK_FORCE_OFF;
+	else
+		deck_state = DECK_OFF;
 }
-DECLARE_HOOK(HOOK_INIT, board_input_module_init, HOOK_PRIO_DEFAULT);
+DECLARE_HOOK(HOOK_INIT, board_input_module_init, HOOK_PRIO_DEFAULT + 2);
 
 static void poll_c_deck(void)
 {
@@ -127,17 +145,24 @@ DECLARE_HOOK(HOOK_TICK, poll_c_deck, HOOK_PRIO_DEFAULT);
 
 static void input_modules_powerup(void)
 {
-	if (deck_state != DECK_FORCE_ON && deck_state != DECK_FORCE_ON)
+	if (deck_state == DECK_FORCE_ON)
+		gpio_pin_set_dt(GPIO_DT_FROM_NODELABEL(gpio_hub_b_pwr_en), 1);
+	else if (deck_state != DECK_FORCE_ON && deck_state != DECK_FORCE_ON)
 		deck_state = DECK_DISCONNECTED;
+
 }
 DECLARE_HOOK(HOOK_CHIPSET_STARTUP, input_modules_powerup, HOOK_PRIO_DEFAULT);
 
 void input_modules_powerdown(void)
 {
-	deck_state = DECK_OFF;
-	gpio_pin_set_dt(GPIO_DT_FROM_NODELABEL(gpio_hub_b_pwr_en), 0);
-	/* Hub mux input 6 is NC, so lower power draw  by disconnecting all PD*/
-	set_hub_mux(TOP_ROW_NOT_CONNECTED);
+	if (deck_state == DECK_FORCE_ON)
+		 gpio_pin_set_dt(GPIO_DT_FROM_NODELABEL(gpio_hub_b_pwr_en), 0);
+	else if (deck_state != DECK_FORCE_ON && deck_state != DECK_FORCE_ON) {
+		deck_state = DECK_OFF;
+		gpio_pin_set_dt(GPIO_DT_FROM_NODELABEL(gpio_hub_b_pwr_en), 0);
+		/* Hub mux input 6 is NC, so lower power draw  by disconnecting all PD */
+		set_hub_mux(TOP_ROW_NOT_CONNECTED);
+	}
 }
 
 int get_deck_state(void)
@@ -148,9 +173,21 @@ int get_deck_state(void)
 /* Host command */
 static enum ec_status check_deck_state(struct host_cmd_handler_args *args)
 {
+	const struct ec_params_deck_state *p = args->params;
 	struct ec_response_deck_state *r = args->response;
 	int idx;
 
+	/* set mode */
+	if (p->mode == 0x01)
+		deck_state = DECK_DISCONNECTED;
+	else if (p->mode == 0x02)
+		deck_state = DECK_FORCE_ON;
+	else if (p->mode == 0x04)
+		deck_state = DECK_FORCE_OFF;
+
+	set_detect_mode(p->mode);
+
+	/* return deck status */
 	for (idx = 0; idx < 8; idx++)
 		r->input_deck_board_id[idx] = (uint8_t)hub_board_id[idx];
 

zephyr/program/lotus/src/board_function.c

@@ -19,6 +19,10 @@
 #include "util.h"
 #include "zephyr_console_shim.h"
 
+#ifdef CONFIG_BOARD_LOTUS
+#include "input_module.h"
+#endif
+
 /* Console output macros */
 #define CPRINTS(format, args...) cprints(CC_HOSTCMD, format, ##args)
 #define CPRINTF(format, args...) cprintf(CC_HOSTCMD, format, ##args)
@@ -64,7 +68,10 @@ void bios_function_detect(void)
 	system_set_bbram(SYSTEM_BBRAM_IDX_BIOS_FUNCTION, ac_boot_status());
 
 	flash_storage_update(FLASH_FLAGS_STANDALONE, get_standalone_mode() ? 1 : 0);
-		flash_storage_commit();
+#ifdef CONFIG_BOARD_LOTUS
+	flash_storage_update(FLASH_FLAGS_INPUT_MODULE_POWER, get_detect_mode());
+#endif
+	flash_storage_commit();
 }
 
 int chassis_cmd_clear(int type)
@@ -140,6 +147,9 @@ static void bios_function_init(void)
 	if (flash_storage_get(FLASH_FLAGS_STANDALONE))
 		set_standalone_mode(1);
 
+#ifdef CONFIG_BOARD_LOTUS
+	set_detect_mode(flash_storage_get(FLASH_FLAGS_INPUT_MODULE_POWER));
+#endif
 	check_chassis_open(1);
 	hook_call_deferred(&board_customer_tick_data, 1000 * MSEC);
 }