New architecture: msp430fr5994lp (MSP430FR5994 Launchpad)

Almost exclusively copypasted from msp430fr5969lp.
May be replaced by symlinks later on.

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;
+}