From b2f7f066dbeed346e6d70414593cad2d918c2bd4 Mon Sep 17 00:00:00 2001
From: Daniel Friesel <derf@finalrewind.org>
Date: Thu, 12 Jul 2018 15:24:36 +0200
Subject: Add arch.idle() command

---
 src/arch/msp430fr5969lp/arch.cc | 11 +++++++++++
 1 file changed, 11 insertions(+)

(limited to 'src/arch/msp430fr5969lp')

diff --git a/src/arch/msp430fr5969lp/arch.cc b/src/arch/msp430fr5969lp/arch.cc
index aee46f3..3016842 100644
--- a/src/arch/msp430fr5969lp/arch.cc
+++ b/src/arch/msp430fr5969lp/arch.cc
@@ -91,6 +91,17 @@ void Arch::idle_loop(void)
 	}
 }
 
+void Arch::idle(void)
+{
+	__eint();
+	asm volatile("nop");
+	__bis_SR_register(LPM2_bits);
+	asm volatile("nop");
+#ifdef WITH_WAKEUP
+		wakeup();
+#endif
+}
+
 Arch arch;
 
 #if defined(WITH_LOOP) || defined(TIMER_S)
-- 
cgit v1.2.3