view src/cs/drivers/drv_app/fchg/fchg_env.c @ 0:92470e5d0b9e

src: partial import from FC Selenite
author Mychaela Falconia <falcon@freecalypso.org>
date Fri, 15 May 2020 01:28:16 +0000
parents
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;
}