# HG changeset patch
# User Mychaela Falconia <falcon@freecalypso.org>
# Date 1513281258 0
# Node ID d583a1f5bd6a48ababe320cfe1ba674c5a84997c
# Parent  8a90038c0173969bbac639fab50c8b881cdd8a3d
FCHG: charger plug and unplug functions implemented

diff -r 8a90038c0173 -r d583a1f5bd6a src/cs/drivers/drv_app/fchg/fchg_env.h
--- a/src/cs/drivers/drv_app/fchg/fchg_env.h	Thu Dec 14 18:35:16 2017 +0000
+++ b/src/cs/drivers/drv_app/fchg/fchg_env.h	Thu Dec 14 19:54:18 2017 +0000
@@ -9,7 +9,8 @@
 #include "fchg/fchg_struct.h"
 #include "fchg/fchg_pool_size.h"
 
-#define FCHG_MAILBOX_USED   RVF_TASK_MBOX_1
+#define	FCHG_MAILBOX		RVF_TASK_MBOX_0
+#define	FCHG_TIMER		RVF_TIMER_0
 
 /* memory bank size and watermark */
 #define FCHG_MB_PRIM_SIZE            FCHG_MB1_SIZE
diff -r 8a90038c0173 -r d583a1f5bd6a src/cs/drivers/drv_app/fchg/fchg_func_i.h
--- a/src/cs/drivers/drv_app/fchg/fchg_func_i.h	Thu Dec 14 18:35:16 2017 +0000
+++ b/src/cs/drivers/drv_app/fchg/fchg_func_i.h	Thu Dec 14 19:54:18 2017 +0000
@@ -13,5 +13,8 @@
 void pwr_set_default_batt_table(void);
 
 void pwr_process_adc(struct pwr_adc_ind_s *msg);
+void pwr_handle_timer(void);
+void pwr_charger_plug(void);
+void pwr_charger_unplug(void);
 
 #endif	/* include guard */
diff -r 8a90038c0173 -r d583a1f5bd6a src/cs/drivers/drv_app/fchg/fchg_process.c
--- a/src/cs/drivers/drv_app/fchg/fchg_process.c	Thu Dec 14 18:35:16 2017 +0000
+++ b/src/cs/drivers/drv_app/fchg/fchg_process.c	Thu Dec 14 19:54:18 2017 +0000
@@ -221,3 +221,76 @@
 				FCHG_USE_ID);
 	}
 }
+
+void pwr_handle_timer(void)
+{
+	if (pwr_ctrl->state != FCHG_STATE_PWR_PLUG_TIMER)
+		return;
+	rvf_send_trace("Timer expired, ready to charge", 30, NULL_PARAM,
+			RV_TRACE_LEVEL_DEBUG_LOW, FCHG_USE_ID);
+	pwr_ctrl->state = FCHG_STATE_READY_TO_CHARGE;
+}
+
+void pwr_charger_plug(void)
+{
+	if (pwr_ctrl->state != FCHG_STATE_NO_EXT_PWR) {
+		rvf_send_trace("Charger plug event in unexpected state", 38,
+				pwr_ctrl->state, RV_TRACE_LEVEL_ERROR,
+				FCHG_USE_ID);
+		return;
+	}
+	if (!pwr_ctrl->config_present) {
+		rvf_send_trace(
+			"Charger plugged in, but no config: won't charge", 47,
+			NULL_PARAM, RV_TRACE_LEVEL_ERROR, FCHG_USE_ID);
+		pwr_ctrl->state = FCHG_STATE_NO_CHARGING;
+		return;
+	}
+	if (pwr_ctrl->config.start_delay) {
+		rvf_send_trace("Charger plug, starting timer", 28, NULL_PARAM,
+				RV_TRACE_LEVEL_DEBUG_HIGH, FCHG_USE_ID);
+		rvf_start_timer(FCHG_TIMER,
+				RVF_MS_TO_TICKS(pwr_ctrl->config.start_delay),
+				FALSE);
+		pwr_ctrl->state = FCHG_STATE_PWR_PLUG_TIMER;
+	} else {
+		rvf_send_trace("Charger plug, ready to charge", 29, NULL_PARAM,
+				RV_TRACE_LEVEL_DEBUG_HIGH, FCHG_USE_ID);
+		pwr_ctrl->state = FCHG_STATE_READY_TO_CHARGE;
+	}
+}
+
+void pwr_charger_unplug(void)
+{
+	switch (pwr_ctrl->state) {
+	case FCHG_STATE_NO_EXT_PWR:
+		rvf_send_trace("Charger unplug, already handled", 31,
+				NULL_PARAM, RV_TRACE_LEVEL_DEBUG_LOW,
+				FCHG_USE_ID);
+		/* nothing to do */
+		return;
+	case FCHG_STATE_PWR_PLUG_TIMER:
+	case FCHG_STATE_READY_TO_CHARGE:
+	case FCHG_STATE_READY_TO_RECHARGE:
+	case FCHG_STATE_I2V_CAL_1:
+	case FCHG_STATE_NO_CHARGING:
+		rvf_send_trace("Charger unplug", 14, NULL_PARAM,
+				RV_TRACE_LEVEL_DEBUG_LOW, FCHG_USE_ID);
+		pwr_ctrl->state = FCHG_STATE_NO_EXT_PWR;
+		return;
+	case FCHG_STATE_I2V_CAL_2:
+	case FCHG_STATE_CI_CHARGING:
+	case FCHG_STATE_CV_CHARGING:
+		ABB_Write_Register_on_page(PAGE0, BCICTL2, 0);
+		rvf_send_trace("Charger unplug, charging stopped", 32,
+				NULL_PARAM, RV_TRACE_LEVEL_DEBUG_HIGH,
+				FCHG_USE_ID);
+		pwr_ctrl->state = FCHG_STATE_NO_EXT_PWR;
+		pwr_init_discharge();
+		return;
+	default:
+		rvf_send_trace("Invalid state in pwr_charger_unplug()", 35,
+				pwr_ctrl->state, RV_TRACE_LEVEL_ERROR,
+				FCHG_USE_ID);
+	}
+}