summaryrefslogtreecommitdiff
diff options
context:
space:
mode:
-rw-r--r--src/arch/msp430fr5969lp/arch.cc49
1 files changed, 49 insertions, 0 deletions
diff --git a/src/arch/msp430fr5969lp/arch.cc b/src/arch/msp430fr5969lp/arch.cc
index 3f0eb3c..fb7d167 100644
--- a/src/arch/msp430fr5969lp/arch.cc
+++ b/src/arch/msp430fr5969lp/arch.cc
@@ -106,6 +106,46 @@ extern void loop();
volatile char run_loop = 0;
#endif
+volatile bool sleep_done = false;
+
+// max delay: 262 ms @ 16 MHz
+// max delay: 524 ms @ 8 MHz
+void Arch::sleep_ms(unsigned int const ms)
+{
+ if (ms == 0) {
+ return;
+ }
+ sleep_done = false;
+#if F_CPU == 16000000UL
+ TA3CTL = TASSEL__SMCLK | ID__8; // /8
+ TA3EX0 = 7; // /8 -> /64 (250 kHz)
+ TA3CCR0 = ms * 250;
+#elif F_CPU == 8000000UL
+ TA3CTL = TASSEL__SMCLK | ID__8; // /8
+ TA3EX0 = 7; // /8 -> /64 (125 kHz)
+ TA3CCR0 = ms * 125;
+#elif F_CPU == 4000000UL
+ TA3CTL = TASSEL__SMCLK | ID__8; // /8
+ TA3EX0 = 3; // /4 -> /32 (125 kHz)
+ TA3CCR0 = ms * 125;
+#elif F_CPU == 1000000UL
+ TA3CTL = TASSEL__SMCLK | ID__8; // /8
+ TA3EX0 = 0; // /1 -> /8 (125 kHz)
+ TA3CCR0 = ms * 125;
+#else
+#error Unsupported F_CPU
+#endif /* F_CPU */
+ TA3CCTL0 = CCIE;
+ TA3CTL |= MC__UP | TACLR;
+ while (!sleep_done) {
+ asm volatile("nop");
+ __bis_SR_register(GIE | LPM2_bits);
+ asm volatile("nop");
+ __dint();
+ }
+ TA3CTL = TASSEL__SMCLK;
+}
+
void Arch::delay_us(unsigned int const us)
{
if (us < 10) {
@@ -162,6 +202,7 @@ Arch arch;
#include "driver/uptime.h"
#ifndef __acweaving
+// overflow interrupts end up in A1 (joint interrupt for CCR1 ... CCR6 and overflow)
__attribute__((interrupt(TIMER1_A1_VECTOR))) __attribute__((wakeup)) void handle_timer1_overflow()
{
if (TA1IV == 0x0e) {
@@ -176,3 +217,11 @@ __attribute__((interrupt(TIMER1_A1_VECTOR))) __attribute__((wakeup)) void handle
#endif
#endif /* defined(WITH_LOOP) || defined(TIMER_S) */
+
+#ifndef __acweaving
+// CCR0 interrupts are exclusive to A0
+__attribute__((interrupt(TIMER3_A0_VECTOR))) __attribute__((wakeup)) void handle_timer3_ccr0()
+{
+ sleep_done = true;
+}
+#endif /* __acweaving */