FreeCalypso > hg > fc-tourmaline
view src/cs/services/lls/lls_functions.c @ 268:f2e52cab0a73
abb_inth.c: check all interrupt causes, not just one
The original code used if - else if - else if etc constructs, thus
the first detected interrupt was the only one handled. However,
Iota ITSTATREG is a clear-on-read register, thus if we only handle
the first detected interrupt and skip checking the others, then the
other interrupts will be lost, if more than one interrupt happened
to occur in one ABB interrupt handling cycle - a form of rare race
condition. Change the code to check all interrupts that were read
in this cycle.
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Sun, 13 Jun 2021 18:17:53 +0000 |
parents | 5bf097aeaad7 |
children |
line wrap: on
line source
/** * @file lls_functions.c * * Implementation of LLS functions. * * @author Laurent Sollier (l-sollier@ti.com) * @version 0.1 */ /* * History: * * Date Author Modification * ---------------------------------------- * 03/12/2002 L Sollier Create * * * (C) Copyright 2002 by Texas Instruments Incorporated, All Rights Reserved */ #ifndef _WINDOWS #include "l1sw.cfg" #include "chipset.cfg" #endif #include "lls/lls_i.h" #include "lls/lls_api.h" #include "spi/spi_api.h" #include "rvf/rvf_api.h" /* Number of available equipment's */ #define NUMBER_OF_EQUIPMENT 3 /* Parameters for each EQUIPMENT */ typedef struct { T_LLS_EQUIPMENT equipment_sort; UINT16 page; UINT16 address; UINT8 bit; } T_EQUIPMENT_PARAM; /* Table of parameters for all the equipment's */ typedef T_EQUIPMENT_PARAM T_EQUIPMENT_PARAM_TABLE[NUMBER_OF_EQUIPMENT]; /* Definition of the parameters for the equipment */ #if (ANLG_FAM == 2) static T_EQUIPMENT_PARAM_TABLE equipment_param_table = { {LLS_LED_A, PAGE1, AUXLED, 0}, {LLS_BACKLIGHT, PAGE1, AUXLED, 1}, {LLS_PRECHARGE_LED, PAGE0, BCICTL2, 5} }; #else static T_EQUIPMENT_PARAM_TABLE equipment_param_table = {0}; #endif /* Save of the action to perform */ typedef struct { T_LLS_EQUIPMENT equipment_index; UINT8 action; } T_ACTION; static T_ACTION action_to_perform = {0}; /* Mutex used to protect perform only one action simultaneously */ static T_RVF_MUTEX mutex; /** * @name Functions implementation * */ /*@{*/ /** * function: lls_initialize */ T_RV_RET lls_initialize(void) { T_RV_RET ret = RV_OK; T_LLS_EQUIPMENT equipment_sort; UINT8 i; /* Mutex initialization */ ret = rvf_initialize_mutex(&mutex); if (ret != RVF_OK) return RV_INTERNAL_ERR; /* Initialisation of the equipment at SWITCH_OFF */ for (i = 0; i < NUMBER_OF_EQUIPMENT; i++) { equipment_sort = equipment_param_table[i].equipment_sort; /* FreeCalypso change: don't touch LED-C, leave it to FCHG SWE */ if (equipment_sort != LLS_PRECHARGE_LED) { ret = lls_switch_off(equipment_sort); if (ret != RV_OK) return RV_INTERNAL_ERR; } } return RV_OK; } /** * function: lls_kill_service */ T_RV_RET lls_kill_service(void) { T_RV_RET ret = RV_OK; ret = rvf_delete_mutex(&mutex); if (ret != RVF_OK) return RV_INTERNAL_ERR; return ret; } /** * function: lls_callback_equipment_status */ void lls_callback_equipment_status(UINT16* equipment_status) { T_RV_RET ret = RV_OK; UINT16 new_equipment_status = *equipment_status; LLS_SEND_TRACE_PARAM("LLS: Received equipment status", (UINT32) new_equipment_status, RV_TRACE_LEVEL_DEBUG_LOW); if (action_to_perform.action == SWITCH_ON) new_equipment_status |= 1 << equipment_param_table[action_to_perform.equipment_index].bit; else new_equipment_status &= ~(1 << equipment_param_table[action_to_perform.equipment_index].bit); LLS_SEND_TRACE_PARAM("LLS: New equipment status", (UINT32) new_equipment_status, RV_TRACE_LEVEL_DEBUG_LOW); ret = spi_abb_write(equipment_param_table[action_to_perform.equipment_index].page, equipment_param_table[action_to_perform.equipment_index].address, new_equipment_status); if (ret != RV_OK) LLS_SEND_TRACE("LLS: Error on SPI read", RV_TRACE_LEVEL_ERROR); rvf_unlock_mutex(&mutex); } /** * function: lls_manage_equipment */ T_RV_RET lls_manage_equipment(UINT8 equipment_index, UINT8 action) { T_RV_RET ret = RV_OK; /* Lock mutex until response from SPI is received */ rvf_lock_mutex(&mutex); /* Save action to do */ action_to_perform.equipment_index = equipment_index; action_to_perform.action = action; ret = spi_abb_read(equipment_param_table[equipment_index].page, equipment_param_table[equipment_index].address, lls_callback_equipment_status); if (ret != RV_OK) LLS_SEND_TRACE("LLS: Error on SPI read", RV_TRACE_LEVEL_ERROR); return ret; } /** * function: lls_search_index */ T_RV_RET lls_search_index(T_LLS_EQUIPMENT equipment, UINT8* equipment_index) { T_RV_RET ret = RV_OK; UINT8 i; for (i = 0; i < NUMBER_OF_EQUIPMENT; i++) if (equipment == equipment_param_table[i].equipment_sort) { *equipment_index = i; return RV_OK; } return RV_INVALID_PARAMETER; } /*@}*/