1 files changed, 201 insertions, 0 deletions

diff --git a/lib/chibios-contrib/os/hal/src/hal_fsmc.c b/lib/chibios-contrib/os/hal/src/hal_fsmc.c
new file mode 100644
index 000000000..c3f2a99fb
--- /dev/null
+++ b/lib/chibios-contrib/os/hal/src/hal_fsmc.c
@@ -0,0 +1,201 @@
+/*
+    ChibiOS/HAL - Copyright (C) 2014 Uladzimir Pylinsky aka barthess
+
+    Licensed under the Apache License, Version 2.0 (the "License");
+    you may not use this file except in compliance with the License.
+    You may obtain a copy of the License at
+
+        http://www.apache.org/licenses/LICENSE-2.0
+
+    Unless required by applicable law or agreed to in writing, software
+    distributed under the License is distributed on an "AS IS" BASIS,
+    WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+    See the License for the specific language governing permissions and
+    limitations under the License.
+*/
+
+/**
+ * @file    hal_fsmc.c
+ * @brief   FSMC Driver subsystem low level driver source template.
+ *
+ * @addtogroup FSMC
+ * @{
+ */
+#include "hal.h"
+
+#if (HAL_USE_SDRAM == TRUE) || (HAL_USE_SRAM == TRUE) || (HAL_USE_NAND == TRUE) || defined(__DOXYGEN__)
+
+/*===========================================================================*/
+/* Driver local definitions.                                                 */
+/*===========================================================================*/
+
+
+
+/*===========================================================================*/
+/* Driver exported variables.                                                */
+/*===========================================================================*/
+
+/**
+ * @brief   FSMC1 driver identifier.
+ */
+#if STM32_FSMC_USE_FSMC1 || defined(__DOXYGEN__)
+FSMCDriver FSMCD1;
+#endif
+
+/*===========================================================================*/
+/* Driver local types.                                                       */
+/*===========================================================================*/
+
+/*===========================================================================*/
+/* Driver local variables and types.                                         */
+/*===========================================================================*/
+
+/*===========================================================================*/
+/* Driver local functions.                                                   */
+/*===========================================================================*/
+
+/*===========================================================================*/
+/* Driver interrupt handlers.                                                */
+/*===========================================================================*/
+
+/*===========================================================================*/
+/* Driver exported functions.                                                */
+/*===========================================================================*/
+
+/**
+ * @brief   Low level FSMC driver initialization.
+ *
+ * @notapi
+ */
+void fsmcInit(void) {
+
+  if (FSMCD1.state == FSMC_UNINIT) {
+    FSMCD1.state  = FSMC_STOP;
+#if HAL_USE_SRAM
+#if STM32_SRAM_USE_SRAM1
+    FSMCD1.sram1 = (FSMC_SRAM_TypeDef *)(FSMC_Bank1_R_BASE);
+#endif
+
+#if STM32_SRAM_USE_SRAM2
+    FSMCD1.sram2 = (FSMC_SRAM_TypeDef *)(FSMC_Bank1_R_BASE + 8);
+#endif
+
+#if STM32_SRAM_USE_SRAM3
+    FSMCD1.sram3 = (FSMC_SRAM_TypeDef *)(FSMC_Bank1_R_BASE + 8 * 2);
+#endif
+
+#if STM32_SRAM_USE_SRAM4
+    FSMCD1.sram4 = (FSMC_SRAM_TypeDef *)(FSMC_Bank1_R_BASE + 8 * 3);
+#endif
+#endif
+
+#if HAL_USE_NAND
+#if STM32_NAND_USE_NAND1
+    FSMCD1.nand1 = (FSMC_NAND_TypeDef *)FSMC_Bank2_R_BASE;
+#endif
+
+#if STM32_NAND_USE_NAND2
+    FSMCD1.nand2 = (FSMC_NAND_TypeDef *)FSMC_Bank3_R_BASE;
+#endif
+#endif
+
+#if HAL_USE_SDRAM
+#if (defined(STM32F427xx) || defined(STM32F437xx) || \
+     defined(STM32F429xx) || defined(STM32F439xx) || \
+     defined(STM32F745xx) || defined(STM32F746xx) || \
+     defined(STM32F756xx) || defined(STM32F767xx) || \
+     defined(STM32F769xx) || defined(STM32F777xx) || \
+     defined(STM32F779xx))
+  #if STM32_SDRAM_USE_SDRAM1 || STM32_SDRAM_USE_SDRAM2
+    FSMCD1.sdram = (FSMC_SDRAM_TypeDef *)FSMC_Bank5_6_R_BASE;
+  #endif
+#endif
+#endif
+  }
+}
+
+/**
+ * @brief   Configures and activates the FSMC peripheral.
+ *
+ * @param[in] fsmcp      pointer to the @p FSMCDriver object
+ *
+ * @notapi
+ */
+void fsmcStart(FSMCDriver *fsmcp) {
+
+  osalDbgAssert((fsmcp->state == FSMC_STOP) || (fsmcp->state == FSMC_READY),
+                "invalid state");
+
+  if (fsmcp->state == FSMC_STOP) {
+    /* Enables the peripheral.*/
+#if STM32_FSMC_USE_FSMC1
+    if (&FSMCD1 == fsmcp) {
+#ifdef rccResetFSMC
+      rccResetFSMC();
+#endif
+      rccEnableFSMC(FALSE);
+#if HAL_USE_NAND
+      nvicEnableVector(STM32_FSMC_NUMBER, STM32_FSMC_FSMC1_IRQ_PRIORITY);
+#endif
+    }
+#endif /* STM32_FSMC_USE_FSMC1 */
+
+    fsmcp->state = FSMC_READY;
+  }
+}
+
+/**
+ * @brief   Deactivates the FSMC peripheral.
+ *
+ * @param[in] emcp      pointer to the @p FSMCDriver object
+ *
+ * @notapi
+ */
+void fsmcStop(FSMCDriver *fsmcp) {
+
+  if (fsmcp->state == FSMC_READY) {
+    /* Resets the peripheral.*/
+#ifdef rccResetFSMC
+    rccResetFSMC();
+#endif
+
+    /* Disables the peripheral.*/
+#if STM32_FSMC_USE_FSMC1
+    if (&FSMCD1 == fsmcp) {
+#if HAL_USE_NAND
+      nvicDisableVector(STM32_FSMC_NUMBER);
+#endif
+      rccDisableFSMC();
+    }
+#endif /* STM32_FSMC_USE_FSMC1 */
+
+    fsmcp->state = FSMC_STOP;
+  }
+}
+
+/**
+ * @brief   FSMC shared interrupt handler.
+ *
+ * @notapi
+ */
+CH_IRQ_HANDLER(STM32_FSMC_HANDLER) {
+
+  CH_IRQ_PROLOGUE();
+#if HAL_USE_NAND
+#if STM32_NAND_USE_NAND1
+  if (FSMCD1.nand1->SR & FSMC_SR_ISR_MASK) {
+    NANDD1.isr_handler(&NANDD1);
+  }
+#endif
+#if STM32_NAND_USE_NAND2
+  if (FSMCD1.nand2->SR & FSMC_SR_ISR_MASK) {
+    NANDD2.isr_handler(&NANDD2);
+  }
+#endif
+#endif
+  CH_IRQ_EPILOGUE();
+}
+
+#endif /* HAL_USE_FSMC */
+
+/** @} */