diff src/cs/services/dar/dar_emergency.c @ 0:4e78acac3d88

src/{condat,cs,gpf,nucleus}: import from Selenite
author Mychaela Falconia <falcon@freecalypso.org>
date Fri, 16 Oct 2020 06:23:26 +0000
parents
children
line wrap: on
line diff
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/src/cs/services/dar/dar_emergency.c	Fri Oct 16 06:23:26 2020 +0000
@@ -0,0 +1,562 @@
+/****************************************************************************/
+/*                                                                          */
+/*  File Name:  dar_emergency.c                                             */
+/*                                                                          */
+/*  Purpose:   This function is called when the DAR entity has detected     */
+/*             an  emergency  ( Error or exception)                         */
+/*                                                                          */
+/*                                                                          */
+/*  Version   0.1                                                           */
+/*                                                                          */
+/*  Date                 Modification                                       */
+/*  ------------------------------------                                    */
+/*  17 October 2001    Create                                               */
+/*                                                                          */
+/*  Author     Stephanie Gerthoux                                           */
+/*                                                                          */
+/* (C) Copyright 2001 by Texas Instruments Incorporated, All Rights Reserved*/
+/****************************************************************************/
+
+#include "rv/rv_defined_swe.h"
+#ifdef RVM_DAR_SWE
+   /* ************************************************ */
+   /*            THE DAR ENTITY IS ENABLED             */
+   /* ************************************************ */
+
+   #include <string.h>
+   #include "rvm/rvm_gen.h"
+   #include "dar/dar_api.h"
+   #include "dar/dar_macro_i.h"
+   #include "dar/dar_messages_i.h"
+   #include "dar/dar_const_i.h"
+   #include "dar/dar_diagnose_i.h"
+   #include "dar/dar_msg_ft.h"
+
+   #ifndef _WINDOWS
+      #include "timer/timer.h"
+   #endif
+
+   /**** Global variable ****/
+   /* index used in the circular buffer*/
+   extern UINT16 dar_current_index;
+
+   /* Write buffer*/
+   extern char dar_write_buffer[DAR_MAX_BUFFER_SIZE];
+
+   /* Get the dar current status */
+   extern T_DAR_RECOVERY_STATUS dar_current_status;
+
+   /* Get the dar exception status */
+   extern UINT8 dar_exception_status;
+
+   /* Define a pointer to the Global Environment Control block   */
+   extern T_DAR_ENV_CTRL_BLK *dar_gbl_var_p;
+
+   /* Define the recovery buffer */
+   extern UINT8   dar_recovery_buffer[DAR_RECOVERY_DATA_MAX_BUFFER_SIZE];
+
+   /* Ram buffer that contains the Debug Unit register */
+   extern UINT32  debug_RAM[DEBUG_UNIT_WORD_SIZE];
+
+
+   /**** Extern functions ****/
+   extern void * dar_read_mbox (UINT8 mbox);
+
+   extern void exception(void);
+
+
+   /********************************************************************************/
+   /*                                                                              */
+   /*    Function Name:   dar_process_emergency                                    */
+   /*                                                                              */
+   /*    Purpose:  This function is called to process emergency data and to store  */ 
+   /*              them in RAM buffer when an emergency has been detected          */
+   /*                                                                              */
+   /*                                                                              */
+   /*    Input Parameters:                                                         */
+   /*        Pointer to the message to store                                       */
+   /*        Data Format, ( the Binary format is not supported)                    */
+   /*        Data Use Id,                                                          */
+   /*        Flags                                                                 */
+   /*                                                                              */
+   /*    Output Parameters:                                                        */
+   /*         Validation of the diagnose execution.                                */
+   /*                                                                              */
+   /*                                                                              */
+   /*                                                                              */
+   /*    Revision History:                                                         */
+   /*        None.                                                                 */
+   /*                                                                              */
+   /********************************************************************************/
+   T_RV_RET dar_process_emergency( T_DAR_INFO    *buffer_p,
+                                   T_DAR_FORMAT  format,
+                                   T_RVM_USE_ID  dar_use_id,
+                                   UINT32 flags)
+   {
+      /* Declare local variables */
+      UINT32    i = 0;
+      UINT32    length = 0;
+      T_RV_HDR   *msg_p = ( T_RV_HDR*) dar_read_mbox(DAR_MBOX);
+
+      /**** Update the DAR recovery status ****/
+      dar_current_status = DAR_EMERGENCY_SCUTTLING;
+
+      /**** Empty the mail box before the reset of the system ****/
+      while(msg_p != NULL)
+      {
+         /* If it's a Write message, store it in the RAM      */
+         /* ( it is not interesting to store filter message ) */
+         if ((msg_p->msg_id) == DAR_WRITE_REQ)
+         {
+            /* store the message in the RAM*/
+            dar_write_data_in_buffer((T_DAR_WRITE_START *)msg_p);
+         }
+
+         /* free the Header of the message */
+         rvf_free_buf((T_RVF_BUFFER *) msg_p);
+
+         /* Read the next message */ 
+         msg_p = ( T_RV_HDR*) dar_read_mbox(DAR_MBOX);
+
+      } /* while (msg_p != NULL) */
+
+      /**** Store emergency data in RAM buffer ****/            
+      /* Diagnose string length */
+      length = (UINT16) strlen(buffer_p);
+
+      /**** Check if the DAR entity is started ****/
+      if (dar_gbl_var_p != NULL )
+      {
+         /* Data format */
+         dar_gbl_var_p->format = format;
+      }
+
+      if ( flags & DAR_NEW_ENTRY )
+      {
+      /**   Circular buffer to store data **/
+      /* Add 0xFF to separate 2 strings */
+      dar_write_buffer[dar_current_index] = 0xF; 
+      DAR_PLUS_PLUS(dar_current_index); /* to detected if it is the end of the buffer */
+      dar_write_buffer[dar_current_index] = 0xF; 
+      DAR_PLUS_PLUS(dar_current_index); /* to detected if it is the end of the buffer */
+
+      /* The group_nb is 16 bit length, and the buffer is an UINT8 length */
+      /* So the group_nb must be stocked by dividing it in 2 parts */
+      dar_write_buffer[dar_current_index] = ((dar_use_id>>16)& 0x7FFF)>>8;
+                                         /*add the 8 first bits of the Use id group*/
+      DAR_PLUS_PLUS(dar_current_index);
+      dar_write_buffer[dar_current_index] = (dar_use_id>>16)& 0x7FFF;
+                                         /*add the 8 last bits of the Use id group*/
+      DAR_PLUS_PLUS(dar_current_index);
+
+      /* The mask is 16 bit length, and the buffer is an UINT8 length */
+      /* So the mask must be stocked by dividing it in 2 parts */
+      dar_write_buffer[dar_current_index] = ((dar_use_id)&0xFFFF)>>8;
+                                         /* add the 8 first bits of the Use id mask */
+      DAR_PLUS_PLUS(dar_current_index);
+      dar_write_buffer[dar_current_index] = (dar_use_id)&0xFFFF;
+                                         /* add the 8 last bits of the Use id mask */
+      DAR_PLUS_PLUS(dar_current_index);
+
+      /* Add the dar_level data */
+      dar_write_buffer[dar_current_index] = DAR_ERROR;
+      DAR_PLUS_PLUS(dar_current_index);
+      }
+
+      /* circular buffer to store diagnose data in RAM buffer */
+      for (i=0; i < length; i++ )
+      {
+         /* copy string in the RAM char by char*/
+         dar_write_buffer[dar_current_index]=buffer_p[i];
+      
+         /* detection of the end of the buffer */
+         /* When current = DAR_MAX_BUFFER_SIZE , current = 0 */
+         DAR_PLUS_PLUS(dar_current_index); 
+      }
+
+      /* DAR information is redirected to standard trace */
+      //DAR_SEND_TRACE("Circular buffer :",RV_TRACE_LEVEL_ERROR);
+      //rvf_send_trace(buffer_p, length, NULL_PARAM, RV_TRACE_LEVEL_ERROR, DAR_USE_ID); 
+
+      /* Trace the buffer (used for debug) */
+      rvf_delay(RVF_MS_TO_TICKS(1000));
+   
+
+      /**** Check if the DAR entity is started ****/
+      if (dar_gbl_var_p != NULL )
+      {
+         if (dar_gbl_var_p->entity_dar_callback != NULL )
+         {
+            /* Call the MMI callback function to save some parameters before reset */
+            dar_gbl_var_p->entity_dar_callback(dar_recovery_buffer,DAR_RECOVERY_DATA_MAX_BUFFER_SIZE);
+         }
+      }
+
+      /* The system is reset if requested */
+      if ( flags & DAR_EMERGENCY_RESET )
+      {
+        dar_reset();
+      }
+      return(RV_OK);
+    
+   } /* dar_process_emergency */
+
+
+   /********************************************************************************/
+   /*                                                                              */
+   /*    Function Name:   dar_exception_arm_undefined                              */
+   /*                                                                              */
+   /*    Purpose:  This function is called to process ARM undefined instruction    */ 
+   /*              exception and to store this exception in the RAM buffer         */
+   /*                                                                              */
+   /*    Input Parameters:                                                         */
+   /*         None                                                                 */
+   /*                                                                              */
+   /*    Output Parameters:                                                        */
+   /*         Validation of the diagnose execution.                                */
+   /*                                                                              */
+   /*                                                                              */
+   /*                                                                              */
+   /*    Revision History:                                                         */
+   /*        None.                                                                 */
+   /*                                                                              */
+   /********************************************************************************/
+   void dar_exception_arm_undefined(void)
+   {
+      /* Declare local variables */
+      T_DAR_INFO *buffer_p= " DAR Emergency exception : ARM undefined ";/*exception data to store*/
+
+      /* Update the DAR recovery status */
+      dar_current_status = DAR_EMERGENCY_SCUTTLING;
+
+      /* Update the DAR exception status */
+      dar_exception_status = DAR_EXCEPTION_UNDEFINED;
+
+      /* Empty the mail box and store data in RAM buffer */
+      dar_empty_mb_and_save_data(buffer_p); 
+
+      /* Check if the DAR entity is started */
+      if (dar_gbl_var_p != NULL )
+      {
+         if (dar_gbl_var_p->entity_dar_callback != NULL)
+         {
+            /* Call the MMI callback function to save some parameters before reset */
+            dar_gbl_var_p->entity_dar_callback(dar_recovery_buffer,DAR_RECOVERY_DATA_MAX_BUFFER_SIZE);
+         }
+      }
+
+      #ifndef _WINDOWS
+         /* branch to "exception" defined in the int.s*/
+         exception();   
+      #endif
+      
+   } /* dar_exception_arm_undefined */
+
+   /********************************************************************************/
+   /*                                                                              */
+   /*    Function Name:   dar_exception_arm_swi                                    */
+   /*                                                                              */
+   /*    Purpose:  This function is called to process ARM SW Interrupt exception   */ 
+   /*              and to store this exception in the RAM buffer                   */
+   /*                                                                              */
+   /*    Input Parameters:                                                         */
+   /*         None                                                                 */
+   /*                                                                              */
+   /*    Output Parameters:                                                        */
+   /*         Validation of the diagnose execution.                                */
+   /*                                                                              */
+   /*                                                                              */
+   /*                                                                              */
+   /*    Revision History:                                                         */
+   /*        None.                                                                 */
+   /*                                                                              */
+   /********************************************************************************/
+   void dar_exception_arm_swi(void)
+   {
+      /* Declare local variables */
+      T_DAR_INFO *buffer_p= " DAR Emergency exception : ARM SWI ";/*exception data to store*/
+
+      /* Update the DAR recovery status */
+      dar_current_status = DAR_EMERGENCY_SCUTTLING;
+
+      /* Update the DAR exception status */
+      dar_exception_status = DAR_EXCEPTION_SWI;
+
+      /* Empty the mail box and store data in RAM buffer */
+      dar_empty_mb_and_save_data(buffer_p);
+
+      /* Check if the DAR entity is started */
+      if (dar_gbl_var_p != NULL )
+      {
+         if ( dar_gbl_var_p->entity_dar_callback != NULL)
+         {
+            /* Call the MMI callback function to save some parameters before reset */
+            dar_gbl_var_p->entity_dar_callback(dar_recovery_buffer,DAR_RECOVERY_DATA_MAX_BUFFER_SIZE);
+         }
+      }
+
+      #ifndef _WINDOWS
+        /* branch to "exception" defined in the int.s*/
+        exception();   
+      #endif
+      
+   } /* dar_exception_arm_swi */
+
+   /********************************************************************************/
+   /*                                                                              */
+   /*    Function Name:   dar_exception_arm_abort_prefetch                         */
+   /*                                                                              */
+   /*    Purpose:  This function is called to process ARM abort prefetch exception */ 
+   /*              and to store this exception in the RAM buffer                   */
+   /*                                                                              */
+   /*    Input Parameters:                                                         */
+   /*         None                                                                 */
+   /*                                                                              */
+   /*    Output Parameters:                                                        */
+   /*         Validation of the diagnose execution.                                */
+   /*                                                                              */
+   /*                                                                              */
+   /*                                                                              */
+   /*    Revision History:                                                         */
+   /*        None.                                                                 */
+   /*                                                                              */
+   /********************************************************************************/
+   void dar_exception_arm_abort_prefetch(void)
+   {
+      #ifndef _WINDOWS
+         /* Local variable */
+         UINT8 i;
+      #endif
+
+   	  #if ((CHIPSET == 7) || (CHIPSET == 8) || (CHIPSET == 10) || (CHIPSET == 11) || (CHIPSET == 12))
+	      /* Debug unit pointer */
+	      volatile UINT32 *debug_register_p;
+	  #endif
+
+      /* Declare local variables */
+      T_DAR_INFO *buffer_p = " DAR Emergency exception : ARM abort prefetch";/*exception data to store*/
+      
+      /* Update the DAR recovery status */
+      dar_current_status   = DAR_EMERGENCY_SCUTTLING;
+
+      /* Update the DAR exception status */
+      dar_exception_status = DAR_EXCEPTION_PREFETCH_ABORT;
+
+      /* Empty the mail box and store data in RAM buffer */
+      dar_empty_mb_and_save_data(buffer_p);
+
+      /* Check if the DAR entity is started */
+      if (dar_gbl_var_p != NULL )
+      {
+         if (dar_gbl_var_p->entity_dar_callback != NULL)
+         {
+            /* Call the MMI callback function to save some parameters before reset */
+            dar_gbl_var_p->entity_dar_callback(dar_recovery_buffer,DAR_RECOVERY_DATA_MAX_BUFFER_SIZE);
+         }
+      }
+
+   	  #if ((CHIPSET == 7) || (CHIPSET == 8) || (CHIPSET == 10) || (CHIPSET == 11) || (CHIPSET == 12))
+	      /* Initialize the adress of the Debug Unit pointer */
+		  debug_register_p = (volatile UINT32*) DAR_DEBUG_UNIT_REGISTER;
+	  #endif    
+
+      #ifndef _WINDOWS
+     	  #if ((CHIPSET == 7) || (CHIPSET == 8) || (CHIPSET == 10) || (CHIPSET == 11) || (CHIPSET == 12))
+	         /* Save the Debug Unit into the RAM */
+		     for (i=0; i<DEBUG_UNIT_WORD_SIZE; i++ )
+	         {
+		        debug_RAM[i] = *debug_register_p;
+			    debug_register_p++;
+			 }
+		  #endif
+
+         /* branch to "exception" defined in the int.s*/
+         exception();    
+      #endif
+      
+   } /* dar_exception_arm_abort_prefetch */
+
+   /********************************************************************************/
+   /*                                                                              */
+   /*    Function Name:   dar_exception_arm_abort_data                             */
+   /*                                                                              */
+   /*    Purpose:  This function is called to process ARM abort data exception     */ 
+   /*              and to store this exception in the RAM buffer                   */
+   /*                                                                              */
+   /*    Input Parameters:                                                         */
+   /*         None                                                                 */
+   /*                                                                              */
+   /*    Output Parameters:                                                        */
+   /*         Validation of the diagnose execution.                                */
+   /*                                                                              */
+   /*                                                                              */
+   /*                                                                              */
+   /*    Revision History:                                                         */
+   /*        None.                                                                 */
+   /*                                                                              */
+   /********************************************************************************/
+   void dar_exception_arm_abort_data(void)
+   {
+      #ifndef _WINDOWS
+         /* Local variable */
+         UINT8 i;
+      #endif
+
+   	  #if ((CHIPSET == 7) || (CHIPSET == 8) || (CHIPSET == 10) || (CHIPSET == 11) || (CHIPSET == 12))
+	      /* Debug unit pointer */
+	      volatile UINT32 *debug_register_p;
+	  #endif
+
+      /* Declare local variables */
+      T_DAR_INFO *buffer_p= " DAR Emergency exception : ARM abort data";/*exception data to store*/
+
+      /* Update the DAR recovery status */
+      dar_current_status = DAR_EMERGENCY_SCUTTLING;
+
+      /* Update the DAR exception status */
+      dar_exception_status = DAR_EXCEPTION_DATA_ABORT;
+
+      /* Empty the mail box and store data in RAM buffer */
+      dar_empty_mb_and_save_data(buffer_p);
+
+      /* Check if the DAR entity is started */
+      if (dar_gbl_var_p != NULL )
+      {
+         if (dar_gbl_var_p->entity_dar_callback != NULL)
+         {
+
+            /* Call the MMI callback function to save some parameters before reset */
+            dar_gbl_var_p->entity_dar_callback(dar_recovery_buffer,DAR_RECOVERY_DATA_MAX_BUFFER_SIZE);
+         }
+      }
+
+	  #if ((CHIPSET == 7) || (CHIPSET == 8) || (CHIPSET == 10) || (CHIPSET == 11) || (CHIPSET == 12))
+		/* Initialize the adress of the Debug Unit pointer */
+		debug_register_p = (volatile UINT32*) DAR_DEBUG_UNIT_REGISTER;
+	  #endif
+
+      #ifndef _WINDOWS
+		 #if ((CHIPSET == 7) || (CHIPSET == 8) || (CHIPSET == 10) || (CHIPSET == 11) || (CHIPSET == 12))
+			/* Save the Debug Unit into the RAM */
+			for (i=0; i<DEBUG_UNIT_WORD_SIZE; i++ )
+			{
+				debug_RAM[i] = *debug_register_p;
+				debug_register_p++;
+			}
+		 #endif
+		
+		 /* branch to "exception" defined in the int.s*/
+         exception();    
+      #endif
+     
+   } /* dar_exception_arm_abort_data */
+
+   /********************************************************************************/
+   /*                                                                              */
+   /*    Function Name:   dar_exception_arm_reserved                               */
+   /*                                                                              */
+   /*    Purpose:  This function is called to process ARM exception                */ 
+   /*              and to store this exception in the RAM buffer                   */
+   /*                                                                              */
+   /*    Input Parameters:                                                         */
+   /*         None                                                                 */
+   /*                                                                              */
+   /*    Output Parameters:                                                        */
+   /*         Validation of the diagnose execution.                                */
+   /*                                                                              */
+   /*                                                                              */
+   /*                                                                              */
+   /*    Revision History:                                                         */
+   /*        None.                                                                 */
+   /*                                                                              */
+   /********************************************************************************/
+   void dar_exception_arm_reserved(void)
+   {
+      /* Declare local variables */
+      T_DAR_INFO *buffer_p= " DAR Emergency exception : ARM reserved";/*exception data to store*/
+
+      /* Update the DAR recovery status */
+      dar_current_status = DAR_EMERGENCY_SCUTTLING;
+
+      /* Update the DAR exception status */
+      dar_exception_status = DAR_EXCEPTION_RESERVED;
+   
+      /* Empty the mail box and store data in RAM buffer */
+      dar_empty_mb_and_save_data(buffer_p);
+
+      /* Check if the DAR entity is started */
+      if (dar_gbl_var_p != NULL )
+      {
+         if (dar_gbl_var_p->entity_dar_callback != NULL)
+         {
+            /* Call the MMI callback function to save some parameters before reset */
+            dar_gbl_var_p->entity_dar_callback(dar_recovery_buffer,DAR_RECOVERY_DATA_MAX_BUFFER_SIZE);
+         }
+      }
+
+      #ifndef _WINDOWS
+         /* branch to "exception" defined in the int.s*/
+         exception();    
+      #endif
+
+   } /* dar_exception_arm_reserved */
+
+  /********************************************************************************/
+  /*                                                                              */
+  /*    Function Name:   dar_exception                                            */
+  /*                                                                              */
+  /*    Purpose:  This function is called to vector exceptions to the correct     */
+  /*              handler                                                         */
+  /*                                                                              */
+  /*    Input Parameters:                                                         */
+  /*         abort type  which come from int.s ( -> magic number)                 */
+  /*                                                                              */
+  /*    Output Parameters:                                                        */
+  /*         Validation of the diagnose execution.                                */
+  /*                                                                              */
+  /*                                                                              */
+  /*                                                                              */
+  /*    Revision History:                                                         */
+  /*        None.                                                                 */
+  /*                                                                              */
+  /********************************************************************************/
+  void dar_exception(int abort_type)
+  {
+      switch (abort_type)
+      {
+         /* magic numbers come from int.s  There is no way to make compiler derived 
+          * constants out of them  
+          */
+         case 1:
+         dar_exception_arm_undefined();
+         break;
+         case 2:
+         dar_exception_arm_swi();
+         break;
+         case 3:
+         dar_exception_arm_abort_prefetch();
+         break;
+         case 4:
+         dar_exception_arm_abort_data();
+         break;
+         case 5:
+         dar_exception_arm_reserved();
+         break;
+      }
+  } /* dar_exception */
+
+#else
+   /* ************************************************ */
+   /*            THE DAR ENTITY IS DISABLED            */
+   /* ************************************************ */
+
+   void dar_exception(int abort_type)
+   {
+      #ifndef _WINDOWS
+         /* branch to "exception" defined in the int.s*/
+         exception();   
+      #endif
+   } /* dar_exception */
+
+#endif /* #ifdef RVM_DAR_SWE */
+