FreeCalypso > hg > fc-magnetite
diff src/cs/drivers/drv_app/fchg/fchg_env.c @ 322:c4077830aeeb
FCHG implementation code started
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Mon, 04 Dec 2017 05:55:58 +0000 |
parents | |
children | ab47ade99fa9 |
line wrap: on
line diff
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/src/cs/drivers/drv_app/fchg/fchg_env.c Mon Dec 04 05:55:58 2017 +0000 @@ -0,0 +1,108 @@ +/* + * This module provides the glue to the RiViera environment + * for our FCHG SWE. + */ + +#include "fchg/fchg_env.h" +#include "rv/rv_general.h" +#include "rvm/rvm_priorities.h" +#include "rvm/rvm_api.h" +#include "rvm/rvm_use_id_list.h" +#include <string.h> + +/* Define a pointer to the PWR environment control block */ +T_PWR_CTRL_BLOCK *pwr_ctrl = NULL; + +/* Define global pointer to the error function */ +static T_RVM_RETURN (*pwr_error_ft) (T_RVM_NAME swe_name, + T_RVM_RETURN error_cause, + T_RVM_ERROR_TYPE error_type, + T_RVM_STRING error_msg); + +T_RVM_RETURN fchg_get_info (T_RVM_INFO_SWE *infoSWE) +{ + /* SWE info */ + + infoSWE->swe_type = RVM_SWE_TYPE_4; + infoSWE->type_info.type4.swe_use_id = FCHG_USE_ID; + memcpy( infoSWE->type_info.type4.swe_name, "FCHG", 5 ); + + infoSWE->type_info.type4.stack_size = FCHG_STACK_SIZE; + infoSWE->type_info.type4.priority = RVM_LCC_TASK_PRIORITY; + + /* memory bank info */ + infoSWE->type_info.type4.nb_mem_bank = 1; + + memcpy ((UINT8 *) infoSWE->type_info.type4.mem_bank[0].bank_name, "FCHG_PRIM", 10); + infoSWE->type_info.type4.mem_bank[0].initial_params.size = FCHG_MB_PRIM_SIZE; + infoSWE->type_info.type4.mem_bank[0].initial_params.watermark = FCHG_MB_PRIM_WATERMARK; + + /* linked SWE info: we use FFS */ + infoSWE->type_info.type4.nb_linked_swe = 1; + infoSWE->type_info.type4.linked_swe_id[0] = FFS_USE_ID; + + /* generic functions */ + infoSWE->type_info.type4.set_info = fchg_set_info; + infoSWE->type_info.type4.init = fchg_init; + infoSWE->type_info.type4.core = fchg_core; + infoSWE->type_info.type4.stop = fchg_stop; + infoSWE->type_info.type4.kill = fchg_kill; + + /* Set the return path */ + infoSWE->type_info.type4.return_path.callback_func = NULL; + infoSWE->type_info.type4.return_path.addr_id = 0; + + return RV_OK; +} + +T_RVM_RETURN fchg_set_info(T_RVF_ADDR_ID addr_id, + T_RV_RETURN return_path[], + T_RVF_MB_ID mbId[], + T_RVM_RETURN (*callBackFct) (T_RVM_NAME SWEntName, + T_RVM_RETURN errorCause, + T_RVM_ERROR_TYPE errorType, + T_RVM_STRING errorMsg)) +{ + + T_RVF_MB_STATUS mb_status; + + mb_status = rvf_get_buf(mbId[0],sizeof(T_PWR_CTRL_BLOCK),(void **) &pwr_ctrl); + if (mb_status == RVF_RED) + { + rvf_send_trace("fchg_set_info: rvf_get_buf() failed", 35, + NULL_PARAM, + RV_TRACE_LEVEL_ERROR, + FCHG_USE_ID); + return (RVM_MEMORY_ERR); + } + memset(pwr_ctrl, 0, sizeof(T_PWR_CTRL_BLOCK)); + + /* store the pointer to the error function */ + pwr_error_ft = callBackFct ; + + /* Store the addr id */ + pwr_ctrl->addr_id = addr_id; + + /* Store the memory bank id */ + pwr_ctrl->prim_id = mbId[0]; + + return RV_OK; +} + +T_RVM_RETURN fchg_init(void) +{ + return RV_OK; +} + +T_RVM_RETURN fchg_stop(void) +{ + return RV_OK; +} + +T_RVM_RETURN fchg_kill(void) +{ + /* free all memory buffer previously allocated */ + rvf_free_buf ((void *) pwr_ctrl); + + return RV_OK; +}