FreeCalypso > hg > fc-tourmaline
view src/cs/services/dar/dar_diagnose.c @ 221:5bf097aeaad7
LLS: when turning off all LEDs on boot, skip LED-C
Having LLS turn off LED-A and LED-B on boot is normally unnecessary
(they should already be off in Iota), but it is harmless, hence this
logic is kept for robustness. However, having LLS read-modify-write
the BCICTL2 register (to turn off LED-C) creates a potential race
condition with FCHG writes to this register, especially in the case
when baseband switch-on is caused by VCHG and charging is expected
to start right away. Furthermore, control of the charging LED itself
(on those hw targets that have it) is the responsibility of the FCHG
SWE, hence LLS should leave it alone.
| author | Mychaela Falconia <falcon@freecalypso.org> |
|---|---|
| date | Mon, 26 Apr 2021 21:55:13 +0000 |
| parents | 4e78acac3d88 |
| 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 */