1 files changed, 89 insertions, 0 deletions
diff --git a/os/io/platforms/LPC214x/pal_lld.c b/os/io/platforms/LPC214x/pal_lld.c
new file mode 100644
index 000000000..666afef55
--- /dev/null
+++ b/os/io/platforms/LPC214x/pal_lld.c
@@ -0,0 +1,89 @@
+/*
+    ChibiOS/RT - Copyright (C) 2006-2007 Giovanni Di Sirio.
+
+    This file is part of ChibiOS/RT.
+
+    ChibiOS/RT is free software; you can redistribute it and/or modify
+    it under the terms of the GNU General Public License as published by
+    the Free Software Foundation; either version 3 of the License, or
+    (at your option) any later version.
+
+    ChibiOS/RT is distributed in the hope that it will be useful,
+    but WITHOUT ANY WARRANTY; without even the implied warranty of
+    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+    GNU General Public License for more details.
+
+    You should have received a copy of the GNU General Public License
+    along with this program.  If not, see <http://www.gnu.org/licenses/>.
+*/
+
+/**
+ * @file LPC214x/pal_lld.c
+ * @brief LPC214x FIO low level driver code
+ * @addtogroup LPC214x_PAL
+ * @{
+ */
+
+#include <ch.h>
+#include <pal.h>
+
+/**
+ * @brief LPC214x I/O ports configuration.
+ * @details FIO units and PINSEL registers initialization.
+ *
+ * @param[in] config the LPC214x ports configuration
+ */
+void _pal_lld_init(const LPC214xFIOConfig *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.
+ *
+ * @param[in] port the port identifier
+ * @param[in] mask the group mask
+ * @param[in] mode the mode
+ *
+ * @note This function is not meant to be invoked directly by the application
+ *       code.
+ * @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.
+ */
+void _pal_lld_setgroupmode(ioportid_t port,
+                           ioportmask_t mask,
+                           uint_fast8_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;
+  case PAL_MODE_OUTPUT_PUSHPULL:
+    port->FIO_DIR |= mask;
+    break;
+  }
+}
+
+/** @} */