From 4e68978f6693ef31ab99d6d34f7d17cb852adca4 Mon Sep 17 00:00:00 2001
From: PaulStoffregen <paul@pjrc.com>
Date: Fri, 7 Apr 2017 10:53:03 -0700
Subject: Adjust millis on Teensy LC

---
 platforms/arm/kl26/clockless_arm_kl26.h | 11 +++++++----
 1 file changed, 7 insertions(+), 4 deletions(-)

(limited to 'platforms')

diff --git a/platforms/arm/kl26/clockless_arm_kl26.h b/platforms/arm/kl26/clockless_arm_kl26.h
index e270f4d5..7138d0c4 100644
--- a/platforms/arm/kl26/clockless_arm_kl26.h
+++ b/platforms/arm/kl26/clockless_arm_kl26.h
@@ -20,15 +20,18 @@ public:
     mPort = FastPinBB<DATA_PIN>::port();
   }
 
-	virtual uint16_t getMaxRefreshRate() const { return 400; }
+  virtual uint16_t getMaxRefreshRate() const { return 400; }
 
   virtual void showPixels(PixelController<RGB_ORDER> & pixels) {
     mWait.wait();
     cli();
-    if(!showRGBInternal(pixels)) {
+    uint32_t clocks = showRGBInternal(pixels);
+    if(!clocks) {
       sei(); delayMicroseconds(WAIT_TIME); cli();
-      showRGBInternal(pixels);
+      clocks = showRGBInternal(pixels);
     }
+    long microsTaken = CLKS_TO_MICROS(clocks * ((T1 + T2 + T3) * 24));
+    MS_COUNTER += (microsTaken / 1000);
     sei();
     mWait.mark();
   }
@@ -59,4 +62,4 @@ public:
 FASTLED_NAMESPACE_END
 
 
-#endif // __INC_CLOCKLESS_ARM_D21
+#endif // __INC_CLOCKLESS_ARM_KL26
-- 
cgit v1.2.3