31 lines
492 B
C
31 lines
492 B
C
#include <msp430g2553.h>
|
|
#include <stdint.h>
|
|
|
|
#include "time.h"
|
|
#include "PontCoopScheduler.h"
|
|
|
|
|
|
volatile uint32_t timestamp;
|
|
|
|
void __attribute__ ((interrupt (TIMER0_A0_VECTOR))) ta0_isr() {
|
|
timestamp++;
|
|
schUpdate();
|
|
}
|
|
|
|
void timeInit() {
|
|
timestamp = 0;
|
|
|
|
TACCR0 = 32;
|
|
TACCTL0 = CCIE;
|
|
TACTL = MC_1 | ID_0 | TASSEL_1 | TACLR;
|
|
}
|
|
|
|
uint32_t getMillis() {
|
|
return timestamp;
|
|
}
|
|
|
|
void ms_active_delay(uint16_t delay) {
|
|
uint32_t start = timestamp;
|
|
while (start + delay > timestamp);
|
|
}
|