1 files changed, 57 insertions, 0 deletions
diff --git a/megalogger/Narcoleptic.cpp b/megalogger/Narcoleptic.cpp
new file mode 100644
index 0000000..5da3924
--- /dev/null
+++ b/megalogger/Narcoleptic.cpp
@@ -0,0 +1,57 @@
+/**
+ * Narcoleptic - A sleep library for Arduino
+ * Copyright (C) 2010 Peter Knight (Cathedrow)
+ *
+ * This program is free software: you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation, either version 3 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program.  If not, see <http://www.gnu.org/licenses/>.
+*/
+
+#include <avr/io.h>
+#include <avr/interrupt.h>
+#include <avr/common.h>
+//#include <util/delay.h>
+
+#include <avr/wdt.h>
+#include <avr/sleep.h>
+#include "Narcoleptic.h"
+
+SIGNAL(WDT_vect) {
+  wdt_disable();
+  wdt_reset();
+  WDTCSR &= ~_BV(WDIE);
+}
+
+void NarcolepticClass::sleep(uint8_t wdt_period) {
+  wdt_enable(wdt_period);
+  wdt_reset();
+  WDTCSR |= _BV(WDIE);
+  set_sleep_mode(SLEEP_MODE_PWR_DOWN);
+  sleep_mode();
+  wdt_disable();
+  WDTCSR &= ~_BV(WDIE);
+}
+
+void NarcolepticClass::delay(int milliseconds) {
+  while (milliseconds >= 8000) { sleep(WDTO_8S); milliseconds -= 8000; }
+  if (milliseconds >= 4000)    { sleep(WDTO_4S); milliseconds -= 4000; }
+  if (milliseconds >= 2000)    { sleep(WDTO_2S); milliseconds -= 2000; }
+  if (milliseconds >= 1000)    { sleep(WDTO_1S); milliseconds -= 1000; }
+  if (milliseconds >= 500)     { sleep(WDTO_500MS); milliseconds -= 500; }
+  if (milliseconds >= 250)     { sleep(WDTO_250MS); milliseconds -= 250; }
+  if (milliseconds >= 125)     { sleep(WDTO_120MS); milliseconds -= 120; }
+  if (milliseconds >= 64)      { sleep(WDTO_60MS); milliseconds -= 60; }
+  if (milliseconds >= 32)      { sleep(WDTO_30MS); milliseconds -= 30; }
+  if (milliseconds >= 16)      { sleep(WDTO_15MS); milliseconds -= 15; }
+}
+
+NarcolepticClass Narcoleptic;