rtc, keeping time

1 files changed, 237 insertions, 0 deletions

diff --git a/drivers_nrf/comp/nrf_drv_comp.c b/drivers_nrf/comp/nrf_drv_comp.c
new file mode 100644
index 0000000..bb026ca
--- /dev/null
+++ b/drivers_nrf/comp/nrf_drv_comp.c
@@ -0,0 +1,237 @@
+/**
+ * Copyright (c) 2015 - 2017, Nordic Semiconductor ASA
+ * 
+ * All rights reserved.
+ * 
+ * Redistribution and use in source and binary forms, with or without modification,
+ * are permitted provided that the following conditions are met:
+ * 
+ * 1. Redistributions of source code must retain the above copyright notice, this
+ *    list of conditions and the following disclaimer.
+ * 
+ * 2. Redistributions in binary form, except as embedded into a Nordic
+ *    Semiconductor ASA integrated circuit in a product or a software update for
+ *    such product, must reproduce the above copyright notice, this list of
+ *    conditions and the following disclaimer in the documentation and/or other
+ *    materials provided with the distribution.
+ * 
+ * 3. Neither the name of Nordic Semiconductor ASA nor the names of its
+ *    contributors may be used to endorse or promote products derived from this
+ *    software without specific prior written permission.
+ * 
+ * 4. This software, with or without modification, must only be used with a
+ *    Nordic Semiconductor ASA integrated circuit.
+ * 
+ * 5. Any software provided in binary form under this license must not be reverse
+ *    engineered, decompiled, modified and/or disassembled.
+ * 
+ * THIS SOFTWARE IS PROVIDED BY NORDIC SEMICONDUCTOR ASA "AS IS" AND ANY EXPRESS
+ * OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
+ * OF MERCHANTABILITY, NONINFRINGEMENT, AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ * DISCLAIMED. IN NO EVENT SHALL NORDIC SEMICONDUCTOR ASA OR CONTRIBUTORS BE
+ * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
+ * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE
+ * GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
+ * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
+ * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
+ * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ * 
+ */
+#include "sdk_common.h"
+#if NRF_MODULE_ENABLED(COMP)
+#include "nrf_drv_comp.h"
+
+#include "nrf_assert.h"
+#include "nrf_error.h"
+#include "nrf_soc.h"
+#include "nrf_drv_common.h"
+#include "app_util_platform.h"
+#include <stdbool.h>
+#include <stddef.h>
+#include <stdint.h>
+
+#define NRF_LOG_MODULE_NAME "COMP"
+
+#if COMP_CONFIG_LOG_ENABLED
+#define NRF_LOG_LEVEL       COMP_CONFIG_LOG_LEVEL
+#define NRF_LOG_INFO_COLOR  COMP_CONFIG_INFO_COLOR
+#define NRF_LOG_DEBUG_COLOR COMP_CONFIG_DEBUG_COLOR
+#define EVT_TO_STR(event)   (event == NRF_COMP_EVENT_READY ? "NRF_COMP_EVENT_READY" :                   \
+                            (event == NRF_COMP_EVENT_DOWN ? "NRF_COMP_EVENT_DOWN" :                     \
+                            (event == NRF_COMP_EVENT_UP ? "NRF_COMP_EVENT_UP" :                         \
+                            (event == NRF_COMP_EVENT_CROSS ? "NRF_COMP_EVENT_CROSS" : "UNKNOWN ERROR"))))
+#else //COMP_CONFIG_LOG_ENABLED
+#define EVT_TO_STR(event)   ""
+#define NRF_LOG_LEVEL       0
+#endif //COMP_CONFIG_LOG_ENABLED
+#include "nrf_log.h"
+#include "nrf_log_ctrl.h"
+
+
+
+static comp_events_handler_t     m_comp_events_handler = NULL;
+static nrf_drv_state_t           m_state = NRF_DRV_STATE_UNINITIALIZED;
+
+static const nrf_drv_comp_config_t m_default_config = NRF_DRV_COMP_DEFAULT_CONFIG(NRF_COMP_INPUT_0);
+
+static void comp_execute_handler(nrf_comp_event_t event, uint32_t event_mask)
+{
+    if ( nrf_comp_event_check(event) && nrf_comp_int_enable_check(event_mask) )
+    {
+        nrf_comp_event_clear(event);
+        NRF_LOG_DEBUG("Event: %s.\r\n", (uint32_t)EVT_TO_STR(event));
+
+        m_comp_events_handler(event);
+    }
+}
+
+#if NRF_MODULE_ENABLED(PERIPHERAL_RESOURCE_SHARING)
+    #define IRQ_HANDLER_NAME   irq_handler_for_comp
+    #define IRQ_HANDLER        static void IRQ_HANDLER_NAME(void)
+
+    IRQ_HANDLER;
+#else
+    #define IRQ_HANDLER void COMP_LPCOMP_IRQHandler(void)
+#endif // NRF_MODULE_ENABLED(PERIPHERAL_RESOURCE_SHARING)
+
+IRQ_HANDLER
+{
+    comp_execute_handler(NRF_COMP_EVENT_READY, COMP_INTENSET_READY_Msk);
+    comp_execute_handler(NRF_COMP_EVENT_DOWN, COMP_INTENSET_DOWN_Msk);
+    comp_execute_handler(NRF_COMP_EVENT_UP, COMP_INTENSET_UP_Msk);
+    comp_execute_handler(NRF_COMP_EVENT_CROSS, COMP_INTENSET_CROSS_Msk);
+}
+
+
+ret_code_t nrf_drv_comp_init(const nrf_drv_comp_config_t * p_config,
+                             comp_events_handler_t   event_handler)
+{
+    ret_code_t err_code;
+
+    if (m_state != NRF_DRV_STATE_UNINITIALIZED)
+    { // COMP driver is already initialized
+        err_code = NRF_ERROR_INVALID_STATE;
+        NRF_LOG_WARNING("Function: %s, error code: %s.\r\n", (uint32_t)__func__, (uint32_t)NRF_LOG_ERROR_STRING_GET(err_code));
+        return err_code;
+    }
+
+    if (p_config == NULL)
+    {
+        p_config = &m_default_config;
+    }
+
+#if NRF_MODULE_ENABLED(PERIPHERAL_RESOURCE_SHARING)
+    if (nrf_drv_common_per_res_acquire(NRF_COMP, IRQ_HANDLER_NAME) != NRF_SUCCESS)
+    {
+        err_code = NRF_ERROR_BUSY;
+        NRF_LOG_WARNING("Function: %s, error code: %s.\r\n", (uint32_t)__func__, (uint32_t)NRF_LOG_ERROR_STRING_GET(err_code));
+        return err_code;
+    }
+#endif
+
+    nrf_comp_task_trigger(NRF_COMP_TASK_STOP);
+    nrf_comp_enable();
+
+    // Clear events to be sure there are no leftovers.
+    nrf_comp_event_clear(NRF_COMP_EVENT_READY);
+    nrf_comp_event_clear(NRF_COMP_EVENT_DOWN);
+    nrf_comp_event_clear(NRF_COMP_EVENT_UP);
+    nrf_comp_event_clear(NRF_COMP_EVENT_CROSS);
+
+    nrf_comp_ref_set(p_config->reference);
+
+    //If external source is chosen, write to appropriate register.
+    if (p_config->reference == COMP_REFSEL_REFSEL_ARef)
+    {
+        nrf_comp_ext_ref_set(p_config->ext_ref);
+    }
+
+    nrf_comp_th_set(p_config->threshold);
+    nrf_comp_main_mode_set(p_config->main_mode);
+    nrf_comp_speed_mode_set(p_config->speed_mode);
+    nrf_comp_hysteresis_set(p_config->hyst);
+    nrf_comp_isource_set(p_config->isource);
+    nrf_comp_shorts_disable(NRF_DRV_COMP_SHORT_STOP_AFTER_CROSS_EVT | NRF_DRV_COMP_SHORT_STOP_AFTER_UP_EVT |
+                            NRF_DRV_COMP_SHORT_STOP_AFTER_DOWN_EVT);
+    nrf_comp_int_disable(COMP_INTENCLR_CROSS_Msk | COMP_INTENCLR_UP_Msk |
+                         COMP_INTENCLR_DOWN_Msk | COMP_INTENCLR_READY_Msk);
+
+    if (event_handler)
+    {
+        m_comp_events_handler = event_handler;
+    }
+    else
+    {
+        err_code = NRF_ERROR_INVALID_PARAM;
+        NRF_LOG_WARNING("Function: %s, error code: %s.\r\n", (uint32_t)__func__, (uint32_t)NRF_LOG_ERROR_STRING_GET(err_code));
+        return err_code;
+    }
+
+    nrf_comp_input_select(p_config->input);
+
+    nrf_drv_common_irq_enable(COMP_LPCOMP_IRQn, p_config->interrupt_priority);
+
+    m_state = NRF_DRV_STATE_INITIALIZED;
+
+    err_code = NRF_SUCCESS;
+    NRF_LOG_INFO("Function: %s, error code: %s.\r\n", (uint32_t)__func__, (uint32_t)NRF_LOG_ERROR_STRING_GET(err_code));
+    return err_code;
+}
+
+
+void nrf_drv_comp_uninit(void)
+{
+    ASSERT(m_state != NRF_DRV_STATE_UNINITIALIZED);
+    nrf_drv_common_irq_disable(COMP_LPCOMP_IRQn);
+    nrf_comp_disable();
+#if NRF_MODULE_ENABLED(PERIPHERAL_RESOURCE_SHARING)
+    nrf_drv_common_per_res_release(NRF_COMP);
+#endif
+    m_state = NRF_DRV_STATE_UNINITIALIZED;
+    m_comp_events_handler = NULL;
+    NRF_LOG_INFO("Uninitialized.\r\n");
+}
+
+void nrf_drv_comp_pin_select(nrf_comp_input_t psel)
+{
+    bool comp_enable_state = nrf_comp_enable_check();
+    nrf_comp_task_trigger(NRF_COMP_TASK_STOP);
+    if (m_state == NRF_DRV_STATE_POWERED_ON)
+    {
+        m_state = NRF_DRV_STATE_INITIALIZED;
+    }
+    nrf_comp_disable();
+    nrf_comp_input_select(psel);
+    if (comp_enable_state == true)
+    {
+        nrf_comp_enable();
+    }
+}
+
+void nrf_drv_comp_start(uint32_t comp_int_mask, uint32_t comp_shorts_mask)
+{
+    ASSERT(m_state == NRF_DRV_STATE_INITIALIZED);
+    nrf_comp_int_enable(comp_int_mask);
+    nrf_comp_shorts_enable(comp_shorts_mask);
+    nrf_comp_task_trigger(NRF_COMP_TASK_START);
+    m_state = NRF_DRV_STATE_POWERED_ON;
+    NRF_LOG_INFO("Enabled.\r\n");
+}
+
+void nrf_drv_comp_stop(void)
+{
+    ASSERT(m_state == NRF_DRV_STATE_POWERED_ON);
+    nrf_comp_shorts_disable(UINT32_MAX);
+    nrf_comp_int_disable(UINT32_MAX);
+    nrf_comp_task_trigger(NRF_COMP_TASK_STOP);
+    m_state = NRF_DRV_STATE_INITIALIZED;
+    NRF_LOG_INFO("Disabled.\r\n");
+}
+
+uint32_t nrf_drv_comp_sample()
+{
+    ASSERT(m_state == NRF_DRV_STATE_POWERED_ON);
+    nrf_comp_task_trigger(NRF_COMP_TASK_SAMPLE);
+    return nrf_comp_result_get();
+}
+#endif //NRF_MODULE_ENABLED(COMP)