3 files changed, 95 insertions, 1 deletions
diff --git a/libraries/Narcoleptic/Narcoleptic.cpp b/libraries/Narcoleptic/Narcoleptic.cpp
new file mode 100644
index 0000000..5da3924
--- /dev/null
+++ b/libraries/Narcoleptic/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;
diff --git a/libraries/Narcoleptic/Narcoleptic.h b/libraries/Narcoleptic/Narcoleptic.h
new file mode 100644
index 0000000..9b1f255
--- /dev/null
+++ b/libraries/Narcoleptic/Narcoleptic.h
@@ -0,0 +1,34 @@
+/**
+ * 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/>.
+*/
+
+#ifndef Narcoleptic_h
+#define Narcoleptic_h
+
+#include <inttypes.h>
+#include <stdbool.h>
+
+class NarcolepticClass
+{
+  public:
+    void delay(int milliseconds);
+  private:
+    void sleep(uint8_t);
+};
+extern NarcolepticClass Narcoleptic;
+
+#endif
diff --git a/megalogger/megalogger.ino b/megalogger/megalogger.ino
index 4a04cb9..b547efa 100644
--- a/megalogger/megalogger.ino
+++ b/megalogger/megalogger.ino
@@ -11,11 +11,12 @@
 #include <Wire.h>
 #endif
 #include <OBD.h>
+#include <SPI.h>
 #include <SD.h>
 #include <MultiLCD.h>
 #include <TinyGPS.h>
 #include <MPU6050.h>
-#include <SPI.h>
+#include <Narcoleptic.h>
 #include "config.h"
 #include "images.h"
 #if ENABLE_DATA_OUT && USE_SOFTSERIAL
@@ -445,6 +446,8 @@ private:
             int value;
             if (read(PID_RPM, value) && value > 0)
                 break;
+
+            Narcoleptic.delay(2000);
         }
         lcd.backlight(true);
         state |= STATE_OBD_READY;