FreeCalypso > hg > ffs-editor
view src/cs/drivers/drv_app/fchg/fchg_env.c @ 23:3ca9a198c6ee
support new FC Tourmaline C139 aftermarket FFS config
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Sun, 18 Oct 2020 02:34:21 +0000 |
parents | 92470e5d0b9e |
children |
line wrap: on
line source
/* * This module provides the glue to the RiViera environment * for our FCHG SWE. */ #include "fchg/fchg_env.h" #include "rv/rv_general.h" #include "rvf/rvf_api.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; }