[ARM] Custom switches delays and durations reworked. Not tested.

This commit is contained in:
bsongis
2013-01-27 21:58:34 +00:00
parent 0b1bdc540e
commit 4c6b4dd061
+10 -12
View File
@@ -711,8 +711,9 @@ volatile GETSWITCH_RECURSIVE_TYPE s_last_switch_value;
/* recursive function. stack as of today (16/03/2012) grows by 8bytes at each call, which is ok! */ /* recursive function. stack as of today (16/03/2012) grows by 8bytes at each call, which is ok! */
#if defined(CPUARM) #if defined(CPUARM)
uint32_t delays[NUM_CSW]; uint32_t cswDelays[NUM_CSW];
uint32_t durations[NUM_CSW]; uint32_t cswDurations[NUM_CSW];
uint8_t cswStates[NUM_CSW];
#endif #endif
int16_t csLastValue[NUM_CSW]; int16_t csLastValue[NUM_CSW];
@@ -862,22 +863,19 @@ bool __getSwitch(int8_t swtch)
#if defined(CPUARM) #if defined(CPUARM)
if (cs->delay) { if (cs->delay) {
if (result) { if (result) {
if (delays[cs_idx] > get_tmr10ms()) if (cswDelays[cs_idx] > get_tmr10ms())
result = false; result = false;
} }
else { else {
delays[cs_idx] = get_tmr10ms() + (cs->delay*50); cswDelays[cs_idx] = get_tmr10ms() + (cs->delay*50);
} }
} }
if (cs->duration) { if (cs->duration) {
if (!result) { if (result && !cswStates[cs_idx])
if (durations[cs_idx] > get_tmr10ms()) { cswDurations[cs_idx] = get_tmr10ms() + (cs->duration*50);
result = true; if (cswDurations[cs_idx] > get_tmr10ms()) {
if (cs->delay) delays[cs_idx] = get_tmr10ms() + (cs->delay*50); result = true;
} if (cs->delay) cswDelays[cs_idx] = get_tmr10ms() + (cs->delay*50);
}
else {
durations[cs_idx] = get_tmr10ms() + (cs->duration*50);
} }
} }