--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/src/cs/services/fcbm/fcbm_charging.c	Sat May 01 10:05:53 2021 +0000
@@ -0,0 +1,68 @@
+/*
+ * In this module we are going to implement FCBM functions
+ * related specifically to charging mode, as opposed to other
+ * special boot modes.
+ */
+
+#include "rv/rv_general.h"
+#include "rvf/rvf_api.h"
+#include "rvm/rvm_use_id_list.h"
+#include "fcbm/fcbm_func_i.h"
+#include "fcbm/fcbm_life_cycle.h"
+#include "fcbm/fcbm_timer_i.h"
+#include "fchg/fchg_api.h"
+#include "r2d/r2d_blrr_api.h"
+#include "abb/abb.h"
+
+void fcbm_process_msg_chg_mode(void)
+{
+	if (fcbm_life_cycle_state != FCBM_STATE_INACTIVE) {
+		rvf_send_trace("FCBM got charging mode request in wrong state",
+				45, fcbm_life_cycle_state,
+				RV_TRACE_LEVEL_ERROR, FCBM_USE_ID);
+		return;
+	}
+	rvf_send_trace("Entering charging boot mode", 27, NULL_PARAM,
+			RV_TRACE_LEVEL_DEBUG_HIGH, FCBM_USE_ID);
+	fcbm_subscribe_kpd();
+	fcbm_setup_long_pwon();
+	/* TODO: display charging boot mode info on the LCD */
+	blrr_display_ctrl(BLRR_DISPLAY_CHG_BOOT);
+	rvf_start_timer(FCBM_TIMER_DSPL_OFF,
+			RVF_SECS_TO_TICKS(FCBM_DISPLAY_SECS), FALSE);
+	rvf_start_timer(FCBM_TIMER_CHG_UPD,
+			RVF_MS_TO_TICKS(FCBM_CHG_UPD_INTERVAL), TRUE);
+	fcbm_life_cycle_state = FCBM_STATE_ACTIVE;
+}
+
+static void charging_info_update(void)
+{
+	/* to be filled */
+}
+
+static void power_off_check(void)
+{
+	SYS_UWORD16 abb_status;
+
+	abb_status = ABB_Read_Status();
+	if (abb_status & CHGPRES)
+		return;
+	rvf_send_trace("Charger unplug, powering off", 28, NULL_PARAM,
+			RV_TRACE_LEVEL_DEBUG_HIGH, FCBM_USE_ID);
+	/* TODO: display appropriate message on the LCD */
+	blrr_display_ctrl(BLRR_DISPLAY_CHG_BOOT);
+	rvf_delay(RVF_MS_TO_TICKS(50));
+	ABB_Power_Off();
+}
+
+void fcbm_chg_periodic_timer(void)
+{
+	if (fcbm_life_cycle_state != FCBM_STATE_ACTIVE) {
+		rvf_send_trace("Charging mode periodic timer in wrong state",
+				43, fcbm_life_cycle_state,
+				RV_TRACE_LEVEL_WARNING, FCBM_USE_ID);
+		return;
+	}
+	power_off_check();
+	charging_info_update();
+}