diff src/cs/services/vibr/vibr_env.c @ 294:e17bdedfbf2b

VIBR SWE initial implementation
author Mychaela Falconia <falcon@freecalypso.org>
date Sun, 27 Mar 2022 08:46:10 +0000
parents
children
line wrap: on
line diff
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/src/cs/services/vibr/vibr_env.c	Sun Mar 27 08:46:10 2022 +0000
@@ -0,0 +1,106 @@
+/*
+ * This module provides the glue to the RiViera environment
+ * for our VIBR SWE.
+ */
+
+#include "vibr/vibr_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>
+
+/* global control block for our SWE */
+struct vibr_env *vibr_env;
+
+/* Define global pointer to the error function */
+static T_RVM_RETURN (*xxx_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 vibr_get_info (T_RVM_INFO_SWE  *infoSWE)
+{
+   /* SWE info */
+
+   infoSWE->swe_type = RVM_SWE_TYPE_4;
+   infoSWE->type_info.type4.swe_use_id = VIBR_USE_ID;
+   memcpy( infoSWE->type_info.type4.swe_name, "VIBR", 5 );
+
+   infoSWE->type_info.type4.stack_size = VIBR_STACK_SIZE;
+   infoSWE->type_info.type4.priority   = RVM_VIBR_TASK_PRIORITY;
+
+   /* memory bank info */
+   infoSWE->type_info.type4.nb_mem_bank = 1;
+
+   memcpy ((UINT8 *) infoSWE->type_info.type4.mem_bank[0].bank_name, "VIBR_PRIM", 10);
+   infoSWE->type_info.type4.mem_bank[0].initial_params.size          = VIBR_MB_PRIM_SIZE;
+   infoSWE->type_info.type4.mem_bank[0].initial_params.watermark     = VIBR_MB_PRIM_WATERMARK;
+
+   /* linked SWE info: none */
+   infoSWE->type_info.type4.nb_linked_swe = 0;
+
+   /* generic functions */
+   infoSWE->type_info.type4.set_info = vibr_set_info;
+   infoSWE->type_info.type4.init     = vibr_init;
+   infoSWE->type_info.type4.core     = vibr_core;
+   infoSWE->type_info.type4.stop     = vibr_stop;
+   infoSWE->type_info.type4.kill     = vibr_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 vibr_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(struct vibr_env),(void **) &vibr_env);
+    if (mb_status == RVF_RED) 
+    {
+        rvf_send_trace("vibr_set_info: rvf_get_buf() failed", 35,
+                       NULL_PARAM, RV_TRACE_LEVEL_ERROR, VIBR_USE_ID);
+        return (RVM_MEMORY_ERR);
+    }
+    memset(vibr_env, 0, sizeof(struct vibr_env));
+
+    /* store the pointer to the error function */
+    xxx_error_ft = callBackFct ;
+
+    /* Store the addr id */
+    vibr_env->addr_id = addr_id;
+
+    /* Store the memory bank id */
+    vibr_env->prim_id = mbId[0];
+
+    return RV_OK;
+}
+
+T_RVM_RETURN vibr_init(void)
+{
+   return RV_OK;
+}
+
+T_RVM_RETURN vibr_stop(void)
+{
+   return RV_OK;
+}
+
+T_RVM_RETURN vibr_kill(void)
+{
+   /* free all memory buffer previously allocated */
+   rvf_free_buf ((void *) vibr_env);
+
+   return RV_OK;
+}