diff options
| -rw-r--r-- | os/hal/ports/SAMA/SAMA5D2x/hal_lld.c | 10 |
1 files changed, 6 insertions, 4 deletions
diff --git a/os/hal/ports/SAMA/SAMA5D2x/hal_lld.c b/os/hal/ports/SAMA/SAMA5D2x/hal_lld.c index 7cd4efa53..b0162087e 100644 --- a/os/hal/ports/SAMA/SAMA5D2x/hal_lld.c +++ b/os/hal/ports/SAMA/SAMA5D2x/hal_lld.c @@ -129,15 +129,17 @@ void sama_clock_init(void) { ; /* Waits until MOSCXT is stable.*/
/* Counter Clock Source to MOSCXT. */
PMC->CKGR_MCFR |= CKGR_MCFR_CCSS;
- PMC->CKGR_MCFR |= CKGR_MCFR_RCMEAS;
- while (!(PMC->CKGR_MCFR & CKGR_MCFR_MAINFRDY))
- ;
- mainf = CKGR_MCFR_MAINF(PMC->CKGR_MCFR);
#else
mor &= ~CKGR_MOR_MOSCXTEN;
PMC->CKGR_MOR = mor;
#endif
+ PMC->CKGR_MCFR |= CKGR_MCFR_RCMEAS;
+ while (!(PMC->CKGR_MCFR & CKGR_MCFR_MAINFRDY))
+ ;
+ mainf = CKGR_MCFR_MAINF(PMC->CKGR_MCFR);
+ (void)mainf;
+
/* Switching Main Clock source. */
mor &= ~CKGR_MOR_MOSCSEL;
mor |= SAMA_MOSC_SEL;
|