FreeCalypso > hg > fc-magnetite
view src/cs/services/dar/dar_diagnose.c @ 327:d7b25dca1266
.../drv_core/abb/abb.c: don't set backup battery bits in BCICONF
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Fri, 08 Dec 2017 03:05:19 +0000 |
parents | 945cf7f506b2 |
children |
line wrap: on
line source
/****************************************************************************/ /* */ /* 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 "rv/rv_defined_swe.h" #ifdef RVM_DAR_SWE #ifndef _WINDOWS #include "timer/timer.h" #endif #include "rv/rv_general.h" #include "rvm/rvm_gen.h" #include "rvm/rvm_priorities.h" #include "dar/dar_api.h" #include "dar/dar_structs_i.h" #include "dar/dar_env.h" #include "rvf/rvf_target.h" #include "dar/dar_const_i.h" #include "dar/dar_macro_i.h" #include "dar/dar_messages_i.h" #include "dar/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 "config/swconfig.cfg" #include "config/sys.cfg" #include "config/chipset.cfg" #include "timer/timer.h" #endif #include "rv/rv_general.h" #include "rvm/rvm_gen.h" #include "rvm/rvm_priorities.h" #include "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 */