Merge pull request #23 from duff2013/master

more 2 MHz (VLPR) fixes

teensy3/core_pins.h

@@ -793,7 +793,8 @@ static inline void delayMicroseconds(uint32_t usec)
 #elif F_CPU == 2000000
 	uint32_t n = usec >> 1;
 #endif
-	if (usec == 0) return;
+    // changed because a delay of 1 micro Sec @ 2MHz will be 0
+	if (n == 0) return;
 	__asm__ volatile(
 		"L_%=_delayMicroseconds:"		"\n\t"
 #if F_CPU < 24000000

teensy3/mk20dx128.c

@@ -391,6 +391,10 @@ void ResetHandler(void)
 	// release I/O pins hold, if we woke up from VLLS mode
 	if (PMC_REGSC & PMC_REGSC_ACKISO) PMC_REGSC |= PMC_REGSC_ACKISO;
 
+    // since this is a write once register, make it visible to all F_CPU's
+    // so we can into other sleep modes in the future at any speed
+	SMC_PMPROT = SMC_PMPROT_AVLP | SMC_PMPROT_ALLS | SMC_PMPROT_AVLLS;
+    
 	// TODO: do this while the PLL is waiting to lock....
 	while (dest < &_edata) *dest++ = *src++;
 	dest = &_sbss;
@@ -542,9 +546,8 @@ void ResetHandler(void)
 #endif
 
 #if F_CPU <= 2000000
-	// switch to VLPR mode....
-	SMC_PMPROT = SMC_PMPROT_AVLP | SMC_PMPROT_ALLS | SMC_PMPROT_AVLLS;
-	SMC_PMCTRL = SMC_PMCTRL_RUNM(2) | SMC_PMCTRL_STOPM(2); // VLPR mode :-)
+    // since we are not going into "stop mode" i removed it
+	SMC_PMCTRL = SMC_PMCTRL_RUNM(2); // VLPR mode :-)
 #endif
 
 	// initialize the SysTick counter