cpu/samd5: valid XOSC32 statup time avoid gclk roundtrip for CPU FDPLL

Author: kfessel

cpu/samd5x/cpu.c

@@ -102,12 +102,16 @@ static void xosc32k_init(void)
         return;
     }
 
+    /* Startup should be a valid value 0 - 6 (~63 ms to 8000 ms) see manual
+     * table 29-2 : 3 ^~= 1 sec
+     * this delay will happen only when the system is booted or the XOSC32
+     * is reenabled after beeing disabled for e.g.: standby*/
     OSC32KCTRL->XOSC32K.reg = OSC32KCTRL_XOSC32K_ENABLE
                             | OSC32KCTRL_XOSC32K_EN1K
                             | OSC32KCTRL_XOSC32K_EN32K
                             | OSC32KCTRL_XOSC32K_RUNSTDBY
                             | OSC32KCTRL_XOSC32K_XTALEN
-                            | OSC32KCTRL_XOSC32K_STARTUP(7);
+                            | OSC32KCTRL_XOSC32K_STARTUP(3);
 
     while (!(OSC32KCTRL->STATUS.reg & OSC32KCTRL_STATUS_XOSC32KRDY)) {}
 }
@@ -197,24 +201,34 @@ static void fdpll_init_nolock(uint8_t idx, uint32_t f_cpu, uint8_t flags)
         return;
     }
 
-    /* Source the DPLL from 32kHz GCLK1 ( equivalent to ((f_cpu << 5) / 32768) ) */
-    const uint32_t LDR = (f_cpu >> 10);
-
     /* disable the DPLL before changing the configuration */
     OSCCTRL->Dpll[idx].DPLLCTRLA.reg &= ~OSCCTRL_DPLLCTRLA_ENABLE;
     while (OSCCTRL->Dpll[idx].DPLLSYNCBUSY.reg) {}
 
-    /* set DPLL clock source */
-    GCLK->PCHCTRL[OSCCTRL_GCLK_ID_FDPLL0 + idx].reg = GCLK_PCHCTRL_GEN(1) | GCLK_PCHCTRL_CHEN;
-    while (!(GCLK->PCHCTRL[OSCCTRL_GCLK_ID_FDPLL0 + idx].reg & GCLK_PCHCTRL_CHEN)) {}
-
-    OSCCTRL->Dpll[idx].DPLLRATIO.reg = OSCCTRL_DPLLRATIO_LDRFRAC(LDR & 0x1F)
-                                     | OSCCTRL_DPLLRATIO_LDR((LDR >> 5) - 1);
-
-    /* Without LBYPASS, startup takes very long, see errata section 2.13. */
-    OSCCTRL->Dpll[idx].DPLLCTRLB.reg = OSCCTRL_DPLLCTRLB_REFCLK_GCLK
-                                     | OSCCTRL_DPLLCTRLB_WUF
-                                     | OSCCTRL_DPLLCTRLB_LBYPASS;
+    if(!EXTERNAL_OSC32_SOURCE){
+        /* set DPLL clock source */
+        GCLK->PCHCTRL[OSCCTRL_GCLK_ID_FDPLL0 + idx].reg = GCLK_PCHCTRL_GEN(1) | GCLK_PCHCTRL_CHEN;
+        while (!(GCLK->PCHCTRL[OSCCTRL_GCLK_ID_FDPLL0 + idx].reg & GCLK_PCHCTRL_CHEN)) {}
+        /* Source the DPLL from 32kHz GCLK1 ( equivalent to ((f_cpu << 5) / 32768) )
+         * avoid the routing through gclk when XOSC32 is the source */
+        const uint32_t LDR = (f_cpu >> 10);
+        OSCCTRL->Dpll[idx].DPLLRATIO.reg  = OSCCTRL_DPLLRATIO_LDRFRAC(LDR & 0x1F)
+        | OSCCTRL_DPLLRATIO_LDR((LDR >> 5) - 1);
+    } else {
+        /* Source the DPLL from 32kHz XOSC32 ( equivalent to ((f_cpu << 5) / 32768) ) */
+        const uint32_t LDR = (f_cpu >> 10);
+        OSCCTRL->Dpll[idx].DPLLRATIO.reg = OSCCTRL_DPLLRATIO_LDRFRAC(LDR & 0x1F)
+        | OSCCTRL_DPLLRATIO_LDR((LDR >> 5) - 1);
+    }
+    /* Without LBYPASS, startup takes very long, see errata section 2.13.
+     * according to the documentation several milliseconds
+     * (critical for some application not so much for other)*/
+    if(EXTERNAL_OSC32_SOURCE){
+        OSCCTRL->Dpll[idx].DPLLCTRLB.reg = OSCCTRL_DPLLCTRLB_REFCLK_XOSC32;
+    }
+    else {
+        OSCCTRL->Dpll[idx].DPLLCTRLB.reg = OSCCTRL_DPLLCTRLB_REFCLK_GCLK;
+    }
 
     OSCCTRL->Dpll[idx].DPLLCTRLA.reg = OSCCTRL_DPLLCTRLA_ENABLE | flags;