temp

Signed-off-by: Rafael Silva <[email protected]>
openinput-fw · Jun 24, 2022 · 4082b5c · 4082b5c
1 parent b945044
commit 4082b5c
Show file tree

Hide file tree

Showing 6 changed files with 735 additions and 0 deletions.
diff --git a/src/platform/sam3u/eefc.c b/src/platform/sam3u/eefc.c
@@ -0,0 +1,31 @@
+/*
+ * SPDX-License-Identifier: MIT
+ * SPDX-FileCopyrightText: 2021 Rafael Silva <[email protected]>
+ */
+
+#include <sam.h>
+
+#include "platform/sam3u/eefc.h"
+
+void eefc_config_waitstates(const u32 frequency)
+{
+	if (frequency <= 27000000UL)
+		EFC0->EEFC_FMR = (EFC0->EEFC_FMR & ~EEFC_FMR_FWS_Msk) | (0 << EEFC_FMR_FWS_Pos);
+	else if (frequency <= 47000000UL)
+		EFC0->EEFC_FMR = (EFC0->EEFC_FMR & ~EEFC_FMR_FWS_Msk) | (1 << EEFC_FMR_FWS_Pos);
+	else if (frequency <= 84000000UL)
+		EFC0->EEFC_FMR = (EFC0->EEFC_FMR & ~EEFC_FMR_FWS_Msk) | (2 << EEFC_FMR_FWS_Pos);
+	else
+		EFC0->EEFC_FMR = (EFC0->EEFC_FMR & ~EEFC_FMR_FWS_Msk) | (3 << EEFC_FMR_FWS_Pos);
+
+#if 0
+	if (frequency <= 27000000UL)
+		EFC1->EEFC_FMR = (EFC0->EEFC_FMR & ~EEFC_FMR_FWS_Msk) | (0 << EEFC_FMR_FWS_Pos);
+	else if (frequency <= 47000000UL)
+		EFC1->EEFC_FMR = (EFC0->EEFC_FMR & ~EEFC_FMR_FWS_Msk) | (1 << EEFC_FMR_FWS_Pos);
+	else if (frequency <= 84000000UL)
+		EFC1->EEFC_FMR = (EFC0->EEFC_FMR & ~EEFC_FMR_FWS_Msk) | (2 << EEFC_FMR_FWS_Pos);
+	else
+		EFC1->EEFC_FMR = (EFC0->EEFC_FMR & ~EEFC_FMR_FWS_Msk) | (3 << EEFC_FMR_FWS_Pos);
+#endif
+}
diff --git a/src/platform/sam3u/eefc.h b/src/platform/sam3u/eefc.h
@@ -0,0 +1,12 @@
+/*
+ * SPDX-License-Identifier: MIT
+ * SPDX-FileCopyrightText: 2021 Rafael Silva <[email protected]>
+ */
+
+#pragma once
+
+#include <sam.h>
+
+#include "util/types.h"
+
+void eefc_config_waitstates(const u32 frequency);