--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/services/dar/dar_diagnose.c	Thu Jun 09 00:02:41 2016 +0000
@@ -0,0 +1,364 @@
+/****************************************************************************/
+/*                                                                          */
+/*  File Name:  dar_diagnose.c                                              */
+/*                                                                          */
+/*  Purpose:   This function contains the DAR diagnose functions            */
+/*                                                                          */
+/*                                                                          */
+/*  Version   0.1                                                           */
+/*                                                                          */
+/*  Date               Modification                                         */
+/*  ------------------------------------                                    */
+/*  18 October 2001    Create                                               */
+/*                                                                          */
+/*  Author     Stephanie Gerthoux                                           */
+/*                                                                          */
+/* (C) Copyright 2001 by Texas Instruments Incorporated, All Rights Reserved*/
+/****************************************************************************/
+
+#include "../../riviera/rv/rv_defined_swe.h"
+#ifdef RVM_DAR_SWE
+   #ifndef _WINDOWS
+     #include "../../bsp/timer.h"
+   #endif
+
+   #include "../../riviera/rv/rv_general.h"
+   #include "../../riviera/rvm/rvm_gen.h"
+   #include "../../riviera/rvm/rvm_priorities.h"
+   #include "dar_api.h"
+   #include "dar_structs_i.h"
+   #include "dar_env.h"
+   #include "../../riviera/rvf/rvf_target.h"
+   #include "dar_const_i.h"
+   #include "dar_macro_i.h"
+   #include "dar_messages_i.h"
+   #include "dar_error_hdlr_i.h"
+   //#include "rvf/rvf_i.h"
+
+   /**** Global variables ****/
+
+   /* Define a pointer to the Global Environment Control block   */
+   extern T_DAR_ENV_CTRL_BLK *dar_gbl_var_p;
+
+
+
+   /***************************************************************************/
+   /* Function         dar_search_group                                       */
+   /*                                                                         */
+   /* Description      This function checks if the use_id group_nb exists:    */
+   /*                                                                         */
+   /***************************************************************************/
+   T_RV_RET dar_search_group(UINT16 group, UINT8 *index_p)
+   {
+      /* Declare local variables */   
+      UINT8 i=0;
+
+      /* Check if the DAR entity is started */
+      if (dar_gbl_var_p != NULL )
+      {
+         /* Search in the dar_filter_array if the group exists */
+         for (i=0;i< DAR_MAX_GROUP_NB; i++)
+         {
+            if(dar_gbl_var_p->dar_filter_array[i].group_nb == group)
+            {
+               *index_p=i;
+               //DAR_SEND_TRACE_PARAM("dar filter_array index",*index_p,RV_TRACE_LEVEL_DEBUG_LOW);
+               return(RV_OK);
+            }
+         }
+         return(RV_NOT_SUPPORTED);
+      }
+      else
+      {
+         return(RV_NOT_READY);
+      }
+   }
+
+   /***************************************************************************/
+   /* Function         dar_add_group                                          */
+   /*                                                                         */
+   /* Description      This function research the index of the first free     */
+   /*                  group                                                  */
+   /***************************************************************************/
+   T_RV_RET dar_add_group(UINT8 *index_p)
+   {
+      /* Declare local variables */
+      UINT8 i=0;
+
+      /* Check if the DAR entity is started */
+      if (dar_gbl_var_p == NULL )
+      {
+         dar_error_trace(DAR_ENTITY_NOT_START);
+         return(RV_NOT_READY);
+      }
+
+      /* Search in the dar_filter_array the first free group */
+      for (i=0;i< DAR_MAX_GROUP_NB; i++)
+      {
+         if(dar_gbl_var_p->dar_filter_array[i].group_nb == DAR_INITIALIZATION_VALUE)
+         {
+            *index_p=i;
+            return(RV_OK);
+         }
+      }
+      return(RV_NOT_SUPPORTED);
+   }
+
+
+   /***************************************************************************/
+   /*                                                                         */
+   /*    Function Name:   dar_send_write_data				      */
+   /*                                                                         */
+   /*    Purpose: This function is called to send write data in the DAR       */
+   /*             mailbox.                                                    */
+   /*    Input Parameters:                                                    */
+   /*        Pointer to the message to store                                  */
+   /*        Data Format,                                                     */
+   /*        Data level,                                                      */
+   /*        Data Use Id,                                                     */
+   /*									      */
+   /*    Output Parameters:                                                   */
+   /*        Validation of the function execution.	                      */
+   /*                                                                         */
+   /*    Note:                                                                */
+   /*        None                                                             */
+   /*                                                                         */
+   /***************************************************************************/
+
+   T_RV_RET dar_send_write_data (  T_DAR_INFO    *buffer_p,
+                                   T_DAR_FORMAT  format,
+                                   T_DAR_LEVEL   diagnose_info_level,
+                                   T_RVM_USE_ID  dar_use_id)
+   {
+      /* Declare local variables */
+      T_RVF_MB_STATUS      mb_status         = RVF_GREEN;
+      T_DAR_WRITE_START   *write_data_p      = NULL;
+
+      /************************** dar_send_write_data **********************/
+
+      if (dar_gbl_var_p != NULL )
+      {
+         /* allocate the memory for the message to send */
+         mb_status = rvf_get_buf (dar_gbl_var_p->mb_dar,
+                                  sizeof (T_DAR_WRITE_START),
+                                  (T_RVF_BUFFER **) (&write_data_p));
+
+         /* If insufficient resources, then report a memory error and abort.*/
+         if (mb_status == RVF_YELLOW)
+         {
+            /* deallocate the memory */
+            rvf_free_buf((T_RVF_BUFFER *)write_data_p);
+            dar_error_trace(DAR_ENTITY_NO_MEMORY);
+            return (RV_NOT_SUPPORTED);
+         }
+         else
+         if (mb_status == RVF_RED)
+         {
+            dar_error_trace(DAR_ENTITY_NO_MEMORY);
+            return (RV_MEMORY_ERR);
+         }
+
+         /* fill the message id         */
+         write_data_p->os_hdr.msg_id = DAR_WRITE_REQ;
+
+         /* fill the addr source id     */
+         write_data_p->os_hdr.src_addr_id = dar_gbl_var_p->addrId;
+
+         /* fill the message parameters */
+         write_data_p->data_write.char_p             = buffer_p ;
+         write_data_p->data_write.data_format        = format;
+         write_data_p->data_write.level              = diagnose_info_level;
+         write_data_p->data_write.use_id.group_nb    = (dar_use_id>>16)& 0x7FFF;
+         write_data_p->data_write.use_id.mask        = (dar_use_id)&0xFFFF;
+
+         /* send the messsage to the DAR entity */
+         rvf_send_msg (dar_gbl_var_p->addrId, 
+                       write_data_p);
+
+         return (RV_OK);
+      }
+      else
+      {
+          return(RV_NOT_READY);
+      }
+
+
+   } /* dar_send_write_data */
+
+   /***************************************************************************/
+   /* Function         dar_reset                                              */
+   /*                                                                         */
+   /* Description      This function is used to reset the system              */
+   /*                                                                         */
+   /*    Input Parameters:                                                    */
+   /*        None                                                             */
+   /*									      */
+   /*    Output Parameters:                                                   */
+   /*        Validation of the function execution.			      */
+   /*                                                                         */
+   /*    Note:                                                                */
+   /*        None                                                             */
+   /*                                                                         */
+   /***************************************************************************/
+   T_RV_RET dar_reset(void)
+   {
+      #ifndef _WINDOWS
+         /* Declare global variable*/
+         volatile UINT16 *register_p;
+         volatile UINT8   i;
+
+      
+         /* enable the Watchdog timer */
+         TM_EnableWatchdog();
+
+         /* Reset the system with the Watchdog */
+         /* initialize the adress of the watchdog timer pointer */
+         register_p = (volatile UINT16 *)WATCHDOG_TIM_MODE;
+
+         /* Write the 0xF5 value to the Watchdog timer mode register to disable
+	    the Watchdog */
+         /* Note the bit 15 must be unchanged ( bit 15 = 1 -> 0x8000)*/
+         *register_p =0x80F5;
+
+         /* Wait a couple of time to be sure that this register has a new
+	    value */
+         for (i=0;i<100;i++);
+
+	 /*
+          * After having received 0xF5 in the Watchdog timer mode register,
+	  * if the second write access is differennt from 0xA0, ARM core is
+	  * reset.
+	  *
+          * The ARM HW core is reset + branch to adress 0x0000 ( SW reset)
+          */
+         *register_p=0x80F5;
+
+         /* Wait until the ARM reset */
+         while(1);
+      #endif
+
+      return(RV_OK);
+   } /* dar_reset */
+
+
+   /***************************************************************************/
+   /*                                                                         */
+   /* Function         dar_read_mbox                                          */
+   /*                                                                         */
+   /* Description      Called by the dar to read a buffer from its mailboxes. */
+   /*                  when the Operating System is out                       */
+   /* Input Parameters:                                                       */
+   /*        None                                                             */
+   /*									      */
+   /* Output Parameters:                                                      */
+   /*        NULL if the mailbox was empty, else the address of a buffer      */
+   /*                                                                         */
+   /***************************************************************************/
+
+   void * dar_read_mbox (UINT8 mbox)
+   {   
+      // void * p_buf	= NULL;
+      // T_RVF_INTERNAL_BUF * p_hdr;
+	 
+      /* Verify if DAR's global struct was set by RVM, then read the mailbox */
+      if (dar_gbl_var_p != NULL )
+	  return rvf_read_addr_mbox (dar_gbl_var_p->addrId, mbox);
+
+      return NULL;
+      
+      // Check if the DAR entity is started 
+      /*if (dar_gbl_var_p != NULL )
+      {
+
+         if ( OSTaskQFirst[dar_gbl_var_p->addrId][mbox] )// if the chained list is not empty 
+         {   
+            p_hdr = OSTaskQFirst[dar_gbl_var_p->addrId][mbox];
+            OSTaskQFirst[dar_gbl_var_p->addrId][mbox] = p_hdr->p_next;
+
+            p_hdr->p_next = NULL;
+
+            #if RVF_ENABLE_BUF_LINKAGE_CHECK
+              RVF_SET_BUF_UNLINKED(p_hdr);	// change buffer status 
+            #endif
+
+            p_buf = (UINT8 *)p_hdr + sizeof(T_RVF_INTERNAL_BUF);
+         }
+      }
+      return (p_buf); */
+   } // dar_read_mbox 
+ 
+#else
+
+   /* ******************************************************* */
+   /*            THE DAR ENTITY IS DISABLED                   */
+   /* ******************************************************* */
+   #ifndef _WINDOWS
+       #include "../../bsp/timer.h"
+   #endif
+
+   #include "../../riviera/rv/rv_general.h"
+   #include "../../riviera/rvm/rvm_gen.h"
+   #include "../../riviera/rvm/rvm_priorities.h"
+   #include "../../riviera/rvf/rvf_target.h"
+   //#include "rvf/rvf_i.h"
+
+   /* Define the Watchdog timer register mode */
+   #define WATCHDOG_TIM_MODE                           (0xFFFFF804)
+
+
+   /***************************************************************************/
+   /* Function         dar_reset                                              */
+   /*                                                                         */
+   /* Description      This function is used to reset the system              */
+   /*                                                                         */
+   /*    Input Parameters:                                                    */
+   /*        None                                                             */
+   /*									      */
+   /*    Output Parameters:                                                   */
+   /*        Validation of the function execution.			      */
+   /*                                                                         */
+   /*    Note:                                                                */
+   /*        None                                                             */
+   /*                                                                         */
+   /***************************************************************************/
+   T_RV_RET dar_reset(void)
+   {
+      #ifndef _WINDOWS
+         /* Declare global variable*/
+         volatile UINT16 *register_p;
+         volatile UINT8   i;
+
+      
+         /* enable the Watchdog timer */
+         TM_EnableWatchdog();
+
+         /* Reset the system with the Watchdog */
+         /* initialize the adress of the watchdog timer pointer */
+         register_p = (volatile UINT16 *)WATCHDOG_TIM_MODE;
+
+         /* Write the 0xF5 value to the Watchdog timer mode register to disable
+	    the Watchdog */
+         /* Note the bit 15 must be unchanged ( bit 15 = 1 -> 0x8000)*/
+         *register_p =0x80F5;
+
+         /* Wait a couple of time to be sure that this register has a new
+	    value */
+         for (i=0;i<100;i++);
+
+	 /*
+          * After having received 0xF5 in the Watchdog timer mode register,
+	  * if the second write access is differennt from 0xA0, ARM core is
+	  * reset.
+	  *
+          * The ARM HW core is reset + branch to adress 0x0000 ( SW reset)
+          */
+         *register_p=0x80F5;
+
+         /* Wait until the ARM reset */
+         while(1);
+      #endif
+
+      return(RV_OK);
+   } /* dar_reset */
+
+#endif /* #ifdef RVM_DAR_SWE */