X-Git-Url: https://git.cryptolib.org/?p=arm-crypto-lib.git;a=blobdiff_plain;f=test_src%2Fsysclock.c;h=02e226c002a940a9834e97bbe9c8ee08b370e900;hp=45d92178366027abb321151419feed1f7549830c;hb=5e75eafde9b0269aa78395bbeb3e79ff36a1f082;hpb=f4853b26a54089e6796fcf115f739f1e9ea7ceb7

diff --git a/test_src/sysclock.c b/test_src/sysclock.c
index 45d9217..02e226c 100644
--- a/test_src/sysclock.c
+++ b/test_src/sysclock.c
@@ -27,13 +27,15 @@
 #define PIOSC_FREQ 16000000UL
 
 void sysclk_set_rawclock(void){
-	uint32_t tmp_rcc;
+	volatile uint32_t tmp_rcc;
 	tmp_rcc = 0; //HW_REG(SYSCTL_BASE+RCC_OFFSET);
 	tmp_rcc &= ~(_BV(RCC_IOSCDIS) | _BV(RCC_MOSCDIS) | _BV(RCC_USESYSDIV));
 	tmp_rcc |= _BV(RCC_BYPASS) | _BV(RCC_PWRDN);
 	tmp_rcc &= ~(3<<RCC_OSCSRC);
 	tmp_rcc |=  (0<<RCC_OSCSRC);
 	HW_REG(SYSCTL_BASE+RCC_OFFSET) = tmp_rcc;
+//	tmp_rcc |= _BV(RCC_PWRDN);
+	HW_REG(SYSCTL_BASE+RCC_OFFSET) = tmp_rcc;
 	HW_REG(SYSCTL_BASE+RCC2_OFFSET) &= ~(_BV(31));
 
 }
@@ -58,10 +60,11 @@ void sysclk_set_freq(uint8_t freq_id){
 	HW_REG(SYSCTL_BASE+RCC2_OFFSET) = rcc2;
 	rcc2 &= ~_BV(RCC2_PWRDN2);
 	HW_REG(SYSCTL_BASE+RCC2_OFFSET) = rcc2;
-	rcc2 |= _BV(RCC2_DIV400) | freq_id<<RCC2_SYSDIV2LSB;
+	rcc2 |= _BV(RCC2_DIV400) | (freq_id<<RCC2_SYSDIV2LSB);
 	HW_REG(SYSCTL_BASE+RCC2_OFFSET) = rcc2;
 	while(!(HW_REG(SYSCTL_BASE+RIS_OFFSET)&_BV(RIS_PLLLRIS))){
 	}
+//	return;
 	rcc2 &= ~_BV(RCC2_BYPASS2);
 	HW_REG(SYSCTL_BASE+RCC2_OFFSET) = rcc2;
 }