1 files changed, 112 insertions, 0 deletions

diff --git a/lib/chibios/os/hal/ports/LPC/LPC214x/hal_pal_lld.c b/lib/chibios/os/hal/ports/LPC/LPC214x/hal_pal_lld.c
new file mode 100644
index 000000000..ba5e96b2b
--- /dev/null
+++ b/lib/chibios/os/hal/ports/LPC/LPC214x/hal_pal_lld.c
@@ -0,0 +1,112 @@
+/*
+    ChibiOS - Copyright (C) 2006..2018 Giovanni Di Sirio
+
+    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    LPC214x/hal_pal_lld.c
+ * @brief   LPC214x FIO low level driver code.
+ *
+ * @addtogroup PAL
+ * @{
+ */
+
+#include "hal.h"
+
+#if HAL_USE_PAL || defined(__DOXYGEN__)
+
+/*===========================================================================*/
+/* Driver exported variables.                                                */
+/*===========================================================================*/
+
+/*===========================================================================*/
+/* Driver local variables and types.                                         */
+/*===========================================================================*/
+
+/*===========================================================================*/
+/* Driver local functions.                                                   */
+/*===========================================================================*/
+
+/*===========================================================================*/
+/* Driver interrupt handlers.                                                */
+/*===========================================================================*/
+
+/*===========================================================================*/
+/* Driver exported functions.                                                */
+/*===========================================================================*/
+
+/**
+ * @brief   LPC214x I/O ports configuration.
+ * @details FIO units and PINSEL registers initialization.
+ *
+ * @param[in] config    the LPC214x ports configuration
+ *
+ * @notapi
+ */
+void _pal_lld_init(const PALConfig *config) {
+
+  /* Enables the access through the fast registers.*/
+  SCS = 3;
+
+  /* I/O pads initial assignment, device drivers may change this setup at a
+   * later time.*/
+  PINSEL0 = config->pinsel0;
+  PINSEL1 = config->pinsel1;
+  PINSEL2 = config->pinsel2;
+
+  /* I/O pads direction initial setting.*/
+  FIO0Base->FIO_MASK = 0;
+  FIO0Base->FIO_PIN = config->P0Data.pin;
+  FIO0Base->FIO_DIR = config->P0Data.dir;
+  FIO1Base->FIO_MASK = 0;
+  FIO1Base->FIO_PIN = config->P1Data.pin;
+  FIO1Base->FIO_DIR = config->P1Data.dir;
+}
+
+/**
+ * @brief   Pads mode setup.
+ * @details This function programs a pads group belonging to the same port
+ *          with the specified mode.
+ * @note    @p PAL_MODE_UNCONNECTED is implemented as push pull output with
+ *          high state.
+ * @note    This function does not alter the @p PINSELx registers. Alternate
+ *          functions setup must be handled by device-specific code.
+ *
+ * @param[in] port      the port identifier
+ * @param[in] mask      the group mask
+ * @param[in] mode      the mode
+ *
+ * @notapi
+ */
+void _pal_lld_setgroupmode(ioportid_t port,
+                           ioportmask_t mask,
+                           iomode_t mode) {
+
+  switch (mode) {
+  case PAL_MODE_RESET:
+  case PAL_MODE_INPUT:
+    port->FIO_DIR &= ~mask;
+    break;
+  case PAL_MODE_UNCONNECTED:
+    port->FIO_PIN |= mask;
+    /* Falls through.*/
+  case PAL_MODE_OUTPUT_PUSHPULL:
+    port->FIO_DIR |= mask;
+    break;
+  }
+}
+
+#endif /* HAL_USE_PAL */
+
+/** @} */