diff options
Diffstat (limited to 'src/arch/msp430fr5994lp/driver/cpufreq.cc')
| -rw-r--r-- | src/arch/msp430fr5994lp/driver/cpufreq.cc | 24 |
1 files changed, 24 insertions, 0 deletions
diff --git a/src/arch/msp430fr5994lp/driver/cpufreq.cc b/src/arch/msp430fr5994lp/driver/cpufreq.cc new file mode 100644 index 0000000..55a74b5 --- /dev/null +++ b/src/arch/msp430fr5994lp/driver/cpufreq.cc @@ -0,0 +1,24 @@ +void CPUFreq::set(unsigned int freq_khz) +{ + /* + * Note: arch drivers assume SMCLK freq == F_CPU + */ + + if (freq_khz == 16000) { + FRCTL0 = FWPW; // unlock FRAM Control + FRCTL0_L = 0x10; // one wait state before FRAM access (required for 8MHz < F_CPU <= 16 MHz) + FRCTL0_H = 0xff; // lock FRAM control by writing an invalid password + } + + CSCTL0_H = CSKEY >> 8; + if (freq_khz == 16000) { + CSCTL1 = DCORSEL | DCOFSEL_4; + } else if (freq_khz == 8000) { + CSCTL1 = DCOFSEL_6; + } else if (freq_khz == 4000) { + CSCTL1 = DCOFSEL_3; + } else if (freq_khz == 1000) { + CSCTL1 = DCOFSEL_0; + } + CSCTL0_H = 0; +} |