Fix time accounting on TI EXP5438 MSP430x5438a experimenters board

This commit is contained in:
Atis Elsts 2014-08-21 18:10:53 +02:00
parent 5acf3fb770
commit 0e9c051485

View File

@ -43,12 +43,26 @@
#define MAX_TICKS (~((clock_time_t)0) / 2)
#define CLOCK_LT(a, b) ((int16_t)((a)-(b)) < 0)
static volatile unsigned long seconds;
static volatile clock_time_t count = 0;
/* last_tar is used for calculating clock_fine, last_ccr might be better? */
static unsigned short last_tar = 0;
/*---------------------------------------------------------------------------*/
static inline uint16_t
read_tar(void)
{
/* Same as clock_counter(), but can be inlined */
uint16_t t1, t2;
do {
t1 = TA1R;
t2 = TA1R;
} while(t1 != t2);
return t1;
}
/*---------------------------------------------------------------------------*/
ISR(TIMER1_A1, timera1)
{
ENERGEST_ON(ENERGEST_TYPE_IRQ);
@ -59,8 +73,9 @@ ISR(TIMER1_A1, timera1)
* Occurrs when timer state is toggled between STOP and CONT. */
while(TA1CTL & MC1 && TA1CCR1 - TA1R == 1);
last_tar = read_tar();
/* Make sure interrupt time is future */
do {
while(!CLOCK_LT(last_tar, TA1CCR1)) {
/* TACTL &= ~MC1;*/
TA1CCR1 += INTERVAL;
/* TACTL |= MC1;*/
@ -78,9 +93,8 @@ ISR(TIMER1_A1, timera1)
++seconds;
energest_flush();
}
} while((TA1CCR1 - TA1R) > INTERVAL);
last_tar = TA1R;
last_tar = read_tar();
}
if(etimer_pending() &&
(etimer_next_expiration_time() - count - 1) > MAX_TICKS) {