diff --git a/firmware/target/arm/as3525/system-as3525.c b/firmware/target/arm/as3525/system-as3525.c index 41cc54301b..74e4f2bc7b 100644 --- a/firmware/target/arm/as3525/system-as3525.c +++ b/firmware/target/arm/as3525/system-as3525.c @@ -262,13 +262,15 @@ void system_init(void) "mcr p15, 0, r0, c1, c0 \n" : : : "r0" ); - CGU_PLLASUP = 0; /* enable PLLA */ + CGU_COUNTA = 0xff; CGU_PLLA = AS3525_PLLA_SETTING; + CGU_PLLASUP = 0; /* enable PLLA */ while(!(CGU_INTCTRL & (1<<0))); /* wait until PLLA is locked */ #if (AS3525_MCLK_SEL == AS3525_CLK_PLLB) - CGU_PLLBSUP = 0; /* enable PLLB */ + CGU_COUNTB = 0xff; CGU_PLLB = AS3525_PLLB_SETTING; + CGU_PLLBSUP = 0; /* enable PLLB */ while(!(CGU_INTCTRL & (1<<1))); /* wait until PLLB is locked */ #endif