Add EXT driver for nRF51

6 files changed, 501 insertions, 1 deletions

diff --git a/os/hal/boards/WVSHARE_BLE400/board.h b/os/hal/boards/WVSHARE_BLE400/board.h
index 189010c..0a93c20 100644
--- a/os/hal/boards/WVSHARE_BLE400/board.h
+++ b/os/hal/boards/WVSHARE_BLE400/board.h
@@ -25,6 +25,8 @@
 #define XTAL_VALUE              16000000
 
 /* GPIO pins. */
+#define KEY1           16
+#define KEY2           17
 #define LED0           18
 #define LED1           19
 #define LED2           20
diff --git a/os/hal/ports/NRF51/NRF51822/ext_lld.c b/os/hal/ports/NRF51/NRF51822/ext_lld.c
new file mode 100644
index 0000000..b8ea34b
--- /dev/null
+++ b/os/hal/ports/NRF51/NRF51822/ext_lld.c
@@ -0,0 +1,168 @@
+/*

+    Copyright (C) 2015 Stephen Caudle

+

+    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    NRF51822/ext_lld.c

+ * @brief   NRF51822 EXT subsystem low level driver source.

+ *

+ * @addtogroup EXT

+ * @{

+ */

+

+#include "hal.h"

+

+#if HAL_USE_EXT || defined(__DOXYGEN__)

+

+#include "ext_lld_isr.h"

+

+/*===========================================================================*/

+/* Driver local definitions.                                                 */

+/*===========================================================================*/

+

+/*===========================================================================*/

+/* Driver exported variables.                                                */

+/*===========================================================================*/

+

+/**

+ * @brief   EXTD1 driver identifier.

+ */

+EXTDriver EXTD1;

+

+/*===========================================================================*/

+/* Driver local variables and types.                                         */

+/*===========================================================================*/

+

+/*===========================================================================*/

+/* Driver local functions.                                                   */

+/*===========================================================================*/

+

+/*===========================================================================*/

+/* Driver interrupt handlers.                                                */

+/*===========================================================================*/

+

+/*===========================================================================*/

+/* Driver exported functions.                                                */

+/*===========================================================================*/

+

+/**

+ * @brief   Low level EXT driver initialization.

+ *

+ * @notapi

+ */

+void ext_lld_init(void) {

+

+  /* Driver initialization.*/

+  extObjectInit(&EXTD1);

+}

+

+/**

+ * @brief   Configures and activates the EXT peripheral.

+ *

+ * @param[in] extp      pointer to the @p EXTDriver object

+ *

+ * @notapi

+ */

+void ext_lld_start(EXTDriver *extp) {

+

+  unsigned i;

+

+  ext_lld_exti_irq_enable();

+

+  /* Configuration of automatic channels.*/

+  for (i = 0; i < EXT_MAX_CHANNELS; i++) {

+    uint32_t config = 0;

+    uint32_t pad = (extp->config->channels[i].mode & EXT_MODE_GPIO_MASK)

+      >> EXT_MODE_GPIO_OFFSET;

+

+    if (extp->config->channels[i].mode & EXT_CH_MODE_BOTH_EDGES)

+      config |= (GPIOTE_CONFIG_POLARITY_Toggle << GPIOTE_CONFIG_POLARITY_Pos);

+    else if (extp->config->channels[i].mode & EXT_CH_MODE_RISING_EDGE)

+      config |= (GPIOTE_CONFIG_POLARITY_LoToHi << GPIOTE_CONFIG_POLARITY_Pos);

+    else

+      config |= (GPIOTE_CONFIG_POLARITY_HiToLo << GPIOTE_CONFIG_POLARITY_Pos);

+

+    config |= (pad << GPIOTE_CONFIG_PSEL_Pos);

+

+    NRF_GPIOTE->CONFIG[i] = config;

+    NRF_GPIOTE->EVENTS_PORT = 0;

+    NRF_GPIOTE->EVENTS_IN[i] = 0;

+

+    if (extp->config->channels[i].mode & EXT_CH_MODE_AUTOSTART)

+      ext_lld_channel_enable(extp, i);

+    else

+      ext_lld_channel_disable(extp, i);

+  }

+}

+

+/**

+ * @brief   Deactivates the EXT peripheral.

+ *

+ * @param[in] extp      pointer to the @p EXTDriver object

+ *

+ * @notapi

+ */

+void ext_lld_stop(EXTDriver *extp) {

+

+  unsigned i;

+

+  (void)extp;

+  ext_lld_exti_irq_disable();

+

+  for (i = 0; i < EXT_MAX_CHANNELS; i++)

+    NRF_GPIOTE->CONFIG[i] = 0;

+

+  NRF_GPIOTE->INTENCLR =

+    (GPIOTE_INTENCLR_IN3_Msk | GPIOTE_INTENCLR_IN2_Msk |

+    GPIOTE_INTENCLR_IN1_Msk | GPIOTE_INTENCLR_IN0_Msk);

+}

+

+/**

+ * @brief   Enables an EXT channel.

+ *

+ * @param[in] extp      pointer to the @p EXTDriver object

+ * @param[in] channel   channel to be enabled

+ *

+ * @notapi

+ */

+void ext_lld_channel_enable(EXTDriver *extp, expchannel_t channel) {

+

+  uint32_t config = NRF_GPIOTE->CONFIG[channel] & ~GPIOTE_CONFIG_MODE_Msk;

+

+  (void)extp;

+  config |= (GPIOTE_CONFIG_MODE_Event << GPIOTE_CONFIG_MODE_Pos);

+

+  NRF_GPIOTE->CONFIG[channel] = config;

+  NRF_GPIOTE->INTENSET = (1 << channel);

+}

+

+/**

+ * @brief   Disables an EXT channel.

+ *

+ * @param[in] extp      pointer to the @p EXTDriver object

+ * @param[in] channel   channel to be disabled

+ *

+ * @notapi

+ */

+void ext_lld_channel_disable(EXTDriver *extp, expchannel_t channel) {

+

+  (void)extp;

+  NRF_GPIOTE->CONFIG[channel] &= ~GPIOTE_CONFIG_MODE_Msk;

+  NRF_GPIOTE->INTENCLR = (1 << channel);

+}

+

+#endif /* HAL_USE_EXT */

+

+/** @} */

diff --git a/os/hal/ports/NRF51/NRF51822/ext_lld.h b/os/hal/ports/NRF51/NRF51822/ext_lld.h
new file mode 100644
index 0000000..11eae69
--- /dev/null
+++ b/os/hal/ports/NRF51/NRF51822/ext_lld.h
@@ -0,0 +1,139 @@
+/*

+    Copyright (C) 2015 Stephen Caudle

+

+    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    NRF51822/ext_lld.h

+ * @brief   NRF51822 GPIOTE subsystem low level driver header.

+ *

+ * @addtogroup EXT

+ * @{

+ */

+

+#ifndef _EXT_LLD_H_

+#define _EXT_LLD_H_

+

+#if HAL_USE_EXT || defined(__DOXYGEN__)

+

+/*===========================================================================*/

+/* Driver constants.                                                         */

+/*===========================================================================*/

+

+/**

+ * @brief   Available number of EXT channels.

+ */

+#define EXT_MAX_CHANNELS      4

+#define EXT_MODE_GPIO_MASK    0xF8        /**< @brief Pad field mask.        */

+#define EXT_MODE_GPIO_OFFSET  3           /**< @brief Pad field offset.      */

+/** @} */

+

+/*===========================================================================*/

+/* Driver pre-compile time settings.                                         */

+/*===========================================================================*/

+

+/*===========================================================================*/

+/* Derived constants and error checks.                                       */

+/*===========================================================================*/

+

+/*===========================================================================*/

+/* Driver data structures and types.                                         */

+/*===========================================================================*/

+

+/**

+ * @brief   EXT channel identifier.

+ */

+typedef uint32_t expchannel_t;

+

+/**

+ * @brief   Type of an EXT generic notification callback.

+ *

+ * @param[in] extp      pointer to the @p EXPDriver object triggering the

+ *                      callback

+ */

+typedef void (*extcallback_t)(EXTDriver *extp, expchannel_t channel);

+

+/**

+ * @brief   Channel configuration structure.

+ */

+typedef struct {

+  /**

+   * @brief Channel mode.

+   */

+  uint32_t              mode;

+  /**

+   * @brief Channel callback.

+   * @details  In the STM32 implementation a @p NULL callback pointer is

+   *           valid and configures the channel as an event sources instead

+   *           of an interrupt source.

+   */

+  extcallback_t         cb;

+} EXTChannelConfig;

+

+/**

+ * @brief   Driver configuration structure.

+ * @note    It could be empty on some architectures.

+ */

+typedef struct {

+  /**

+   * @brief Channel configurations.

+   */

+  EXTChannelConfig      channels[EXT_MAX_CHANNELS];

+  /* End of the mandatory fields.*/

+} EXTConfig;

+

+/**

+ * @brief   Structure representing an EXT driver.

+ */

+struct EXTDriver {

+  /**

+   * @brief Driver state.

+   */

+  extstate_t                state;

+  /**

+   * @brief Current configuration data.

+   */

+  const EXTConfig           *config;

+  /* End of the mandatory fields.*/

+};

+

+/*===========================================================================*/

+/* Driver macros.                                                            */

+/*===========================================================================*/

+

+/*===========================================================================*/

+/* External declarations.                                                    */

+/*===========================================================================*/

+

+#if !defined(__DOXYGEN__)

+extern EXTDriver EXTD1;

+#endif

+

+#ifdef __cplusplus

+extern "C" {

+#endif

+  void ext_lld_init(void);

+  void ext_lld_start(EXTDriver *extp);

+  void ext_lld_stop(EXTDriver *extp);

+  void ext_lld_channel_enable(EXTDriver *extp, expchannel_t channel);

+  void ext_lld_channel_disable(EXTDriver *extp, expchannel_t channel);

+#ifdef __cplusplus

+}

+#endif

+

+#endif /* HAL_USE_EXT */

+

+#endif /* _EXT_LLD_H_ */

+

+/** @} */

diff --git a/os/hal/ports/NRF51/NRF51822/ext_lld_isr.c b/os/hal/ports/NRF51/NRF51822/ext_lld_isr.c
new file mode 100644
index 0000000..bdb25da
--- /dev/null
+++ b/os/hal/ports/NRF51/NRF51822/ext_lld_isr.c
@@ -0,0 +1,110 @@
+/*

+    Copyright (C) 2015 Stephen Caudle

+

+    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    NRF51x22/ext_lld_isr.h

+ * @brief   NRF51x22 EXT subsystem low level driver ISR code.

+ *

+ * @addtogroup EXT

+ * @{

+ */

+

+#include "hal.h"

+

+#if HAL_USE_EXT || defined(__DOXYGEN__)

+

+#include "ext_lld_isr.h"

+

+/*===========================================================================*/

+/* Driver local definitions.                                                 */

+/*===========================================================================*/

+

+/*===========================================================================*/

+/* Driver exported variables.                                                */

+/*===========================================================================*/

+

+/*===========================================================================*/

+/* Driver local variables.                                                   */

+/*===========================================================================*/

+

+/*===========================================================================*/

+/* Driver local functions.                                                   */

+/*===========================================================================*/

+

+/*===========================================================================*/

+/* Driver interrupt handlers.                                                */

+/*===========================================================================*/

+

+/**

+ * @brief   EXTI[0]...EXTI[1] interrupt handler.

+ *

+ * @isr

+ */

+OSAL_IRQ_HANDLER(Vector58) {

+

+  OSAL_IRQ_PROLOGUE();

+

+  if (NRF_GPIOTE->EVENTS_IN[0])

+  {

+    NRF_GPIOTE->EVENTS_IN[0] = 0;

+    EXTD1.config->channels[0].cb(&EXTD1, 0);

+  }

+  if (NRF_GPIOTE->EVENTS_IN[1])

+  {

+    NRF_GPIOTE->EVENTS_IN[1] = 0;

+    EXTD1.config->channels[1].cb(&EXTD1, 1);

+  }

+  if (NRF_GPIOTE->EVENTS_IN[2])

+  {

+    NRF_GPIOTE->EVENTS_IN[2] = 0;

+    EXTD1.config->channels[2].cb(&EXTD1, 2);

+  }

+  if (NRF_GPIOTE->EVENTS_IN[3])

+  {

+    NRF_GPIOTE->EVENTS_IN[3] = 0;

+    EXTD1.config->channels[3].cb(&EXTD1, 3);

+  }

+

+  OSAL_IRQ_EPILOGUE();

+}

+

+/*===========================================================================*/

+/* Driver exported functions.                                                */

+/*===========================================================================*/

+

+/**

+ * @brief   Enables EXTI IRQ sources.

+ *

+ * @notapi

+ */

+void ext_lld_exti_irq_enable(void) {

+

+  nvicEnableVector(GPIOTE_IRQn, NRF51_EXT_GPIOTE_IRQ_PRIORITY);

+}

+

+/**

+ * @brief   Disables EXTI IRQ sources.

+ *

+ * @notapi

+ */

+void ext_lld_exti_irq_disable(void) {

+

+  nvicDisableVector(GPIOTE_IRQn);

+}

+

+#endif /* HAL_USE_EXT */

+

+/** @} */

diff --git a/os/hal/ports/NRF51/NRF51822/ext_lld_isr.h b/os/hal/ports/NRF51/NRF51822/ext_lld_isr.h
new file mode 100644
index 0000000..5ea8763
--- /dev/null
+++ b/os/hal/ports/NRF51/NRF51822/ext_lld_isr.h
@@ -0,0 +1,79 @@
+/*

+    Copyright (C) 2015 Stephen Caudle

+

+    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    NRF51x22/ext_lld_isr.h

+ * @brief   NRF51x22 EXT subsystem low level driver ISR header.

+ *

+ * @addtogroup EXT

+ * @{

+ */

+

+#ifndef _EXT_LLD_ISR_H_

+#define _EXT_LLD_ISR_H_

+

+#if HAL_USE_EXT || defined(__DOXYGEN__)

+

+/*===========================================================================*/

+/* Driver constants.                                                         */

+/*===========================================================================*/

+

+/*===========================================================================*/

+/* Driver pre-compile time settings.                                         */

+/*===========================================================================*/

+

+/**

+ * @name    Configuration options

+ * @{

+ */

+/**

+ * @brief   GPIOTE interrupt priority level setting.

+ */

+#if !defined(NRF51_EXT_GPIOTE_IRQ_PRIORITY) || defined(__DOXYGEN__)

+#define NRF51_EXT_GPIOTE_IRQ_PRIORITY      3

+#endif

+/** @} */

+

+/*===========================================================================*/

+/* Derived constants and error checks.                                       */

+/*===========================================================================*/

+

+/*===========================================================================*/

+/* Driver data structures and types.                                         */

+/*===========================================================================*/

+

+/*===========================================================================*/

+/* Driver macros.                                                            */

+/*===========================================================================*/

+

+/*===========================================================================*/

+/* External declarations.                                                    */

+/*===========================================================================*/

+

+#ifdef __cplusplus

+extern "C" {

+#endif

+  void ext_lld_exti_irq_enable(void);

+  void ext_lld_exti_irq_disable(void);

+#ifdef __cplusplus

+}

+#endif

+

+#endif /* HAL_USE_EXT */

+

+#endif /* _EXT_LLD_ISR_H_ */

+

+/** @} */

diff --git a/os/hal/ports/NRF51/NRF51822/platform.mk b/os/hal/ports/NRF51/NRF51822/platform.mk
index 4647bc1..885b16e 100644
--- a/os/hal/ports/NRF51/NRF51822/platform.mk
+++ b/os/hal/ports/NRF51/NRF51822/platform.mk
@@ -4,7 +4,9 @@ PLATFORMSRC = ${CHIBIOS}/os/hal/ports/common/ARMCMx/nvic.c \
               ${CHIBIOS}/community/os/hal/ports/NRF51/NRF51822/pal_lld.c \
               ${CHIBIOS}/community/os/hal/ports/NRF51/NRF51822/serial_lld.c \
               ${CHIBIOS}/community/os/hal/ports/NRF51/NRF51822/st_lld.c \
-              ${CHIBIOS}/community/os/hal/ports/NRF51/NRF51822/spi_lld.c
+              ${CHIBIOS}/community/os/hal/ports/NRF51/NRF51822/spi_lld.c \
+              ${CHIBIOS}/community/os/hal/ports/NRF51/NRF51822/ext_lld_isr.c \
+              ${CHIBIOS}/community/os/hal/ports/NRF51/NRF51822/ext_lld.c
 
 # Required include directories
 PLATFORMINC = ${CHIBIOS}/os/hal/ports/common/ARMCMx \