+
−/*
+
− * The FCHG task's core function lives here.
+
− */
+
−
+
−#include "fchg/fchg_env.h"
+
−#include "fchg/fchg_func_i.h"
+
−#include "fchg/bsim_func_i.h"
+
−#include "rv/rv_general.h"
+
−#include "rvf/rvf_api.h"
+
−#include "rvm/rvm_use_id_list.h"
+
−#include "abb/abb.h"
+
−#include "etm/etm.h"
+
−#include "etm/etm_api.h"
+
−
+
−static void set_initial_state(void)
+
−{
+
−	SYS_UWORD16 abb_status;
+
−
+
−	abb_status = ABB_Read_Status();
+
−	if (abb_status & CHGPRES) {
+
−		if (pwr_ctrl->config_present || pwr_ctrl->bsim_mode)
+
−			pwr_ctrl->state = FCHG_STATE_READY_TO_CHARGE;
+
−		else
+
−			pwr_ctrl->state = FCHG_STATE_NO_CHARGING;
+
−	} else
+
−		pwr_ctrl->state = FCHG_STATE_NO_EXT_PWR;
+
−}
+
−
+
−T_RV_RET fchg_core(void)
+
−{	
+
−	BOOLEAN error_occured = FALSE;
+
−	T_RV_HDR *msg_ptr;
+
−
+
−	rvf_send_trace("FCHG task: Initialization", 25, NULL_PARAM,
+
−			RV_TRACE_LEVEL_DEBUG_LOW, FCHG_USE_ID);
+
−	pwr_load_ffs_batt_table();
+
−	pwr_check_ffs_bsim();
+
−	if (!pwr_ctrl->bsim_mode)
+
−		pwr_load_ffs_charging_config();
+
−	set_initial_state();
+
−	/* just for safety, clear any previous BCI hardware state */
+
−	ABB_Write_Register_on_page(PAGE0, BCICTL2, 0);
+
−	if (pwr_ctrl->bsim_mode) {
+
−		bsim_init_percent();
+
−		etm_register("BSIM", ETM_BSIM, 0, pwr_ctrl->addr_id, 0);
+
−	} else
+
−		pwr_init_discharge();
+
−
+
−	/* loop to process messages */
+
−	while (error_occured == FALSE)
+
−	{
+
−		/* Wait for the necessary events (infinite wait for a msg in the mailbox 0). */
+
−		UINT16 received_event = rvf_wait (0xffff, 0);
+
−					
+
−		/* If an event related to mailbox 0 is received, then */
+
−		if (received_event & RVF_TASK_MBOX_0_EVT_MASK) 
+
−		{
+
−			/* Read the message in the driver mailbox and delegate action..*/
+
−			msg_ptr = (T_RV_HDR *) rvf_read_mbox(FCHG_MAILBOX);
+
−			if (msg_ptr) {
+
−				pwr_process_message(msg_ptr);
+
−				rvf_free_buf ((void *) msg_ptr);
+
−			}
+
−		}
+
−
+
−		/* Timers */
+
−		if (received_event & RVF_TIMER_0_EVT_MASK)
+
−			pwr_handle_timer();
+
−
+
−	}	 // end of while
+
−	return RV_OK;	
+
−}