my new gear...

Dependencies:   mbed

Revision:
6:e7f2335456c8
Parent:
3:a9b4b2565a23
--- a/control_theory/nap.cpp	Sun Mar 27 06:43:22 2022 +0000
+++ b/control_theory/nap.cpp	Sat Apr 09 03:20:19 2022 +0000
@@ -9,6 +9,12 @@
         now_time = nap.read_ms();
     }
     prev_time = now_time;
+    if(prev_time > 18000000){
+        now_time  = 0;
+        prev_time = 0;
+        nap.reset();
+        nap.start();    
+    }
 }
 
 void NAP::setNaptime(float nap_time){