123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211 |
- /**
- * Copyright (c) 2015 - 2020, 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 <nrfx.h>
- #if NRFX_CHECK(NRFX_COMP_ENABLED)
- #include <nrfx_comp.h>
- #include "prs/nrfx_prs.h"
- #define NRFX_LOG_MODULE COMP
- #include <nrfx_log.h>
- #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"))))
- static nrfx_comp_event_handler_t m_comp_event_handler = NULL;
- static nrfx_drv_state_t m_state = NRFX_DRV_STATE_UNINITIALIZED;
- 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);
- NRFX_LOG_DEBUG("Event: %s.", EVT_TO_STR(event));
- m_comp_event_handler(event);
- }
- }
- void nrfx_comp_irq_handler(void)
- {
- 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);
- }
- nrfx_err_t nrfx_comp_init(nrfx_comp_config_t const * p_config,
- nrfx_comp_event_handler_t event_handler)
- {
- NRFX_ASSERT(p_config);
- NRFX_ASSERT(event_handler);
- nrfx_err_t err_code;
- if (m_state != NRFX_DRV_STATE_UNINITIALIZED)
- { // COMP driver is already initialized
- err_code = NRFX_ERROR_INVALID_STATE;
- NRFX_LOG_WARNING("Function: %s, error code: %s.",
- __func__,
- NRFX_LOG_ERROR_STRING_GET(err_code));
- return err_code;
- }
- m_comp_event_handler = event_handler;
- #if NRFX_CHECK(NRFX_PRS_ENABLED)
- if (nrfx_prs_acquire(NRF_COMP, nrfx_comp_irq_handler) != NRFX_SUCCESS)
- {
- err_code = NRFX_ERROR_BUSY;
- NRFX_LOG_WARNING("Function: %s, error code: %s.",
- __func__,
- NRFX_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);
- #if defined (COMP_ISOURCE_ISOURCE_Msk)
- nrf_comp_isource_set(p_config->isource);
- #endif
- nrf_comp_shorts_disable(NRFX_COMP_SHORT_STOP_AFTER_CROSS_EVT |
- NRFX_COMP_SHORT_STOP_AFTER_UP_EVT |
- NRFX_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);
- nrf_comp_input_select(p_config->input);
- NRFX_IRQ_PRIORITY_SET(nrfx_get_irq_number(NRF_COMP), p_config->interrupt_priority);
- NRFX_IRQ_ENABLE(nrfx_get_irq_number(NRF_COMP));
- m_state = NRFX_DRV_STATE_INITIALIZED;
- err_code = NRFX_SUCCESS;
- NRFX_LOG_INFO("Function: %s, error code: %s.", __func__, NRFX_LOG_ERROR_STRING_GET(err_code));
- return err_code;
- }
- void nrfx_comp_uninit(void)
- {
- NRFX_ASSERT(m_state != NRFX_DRV_STATE_UNINITIALIZED);
- NRFX_IRQ_DISABLE(nrfx_get_irq_number(NRF_COMP));
- nrf_comp_disable();
- #if NRFX_CHECK(NRFX_PRS_ENABLED)
- nrfx_prs_release(NRF_COMP);
- #endif
- m_state = NRFX_DRV_STATE_UNINITIALIZED;
- m_comp_event_handler = NULL;
- NRFX_LOG_INFO("Uninitialized.");
- }
- void nrfx_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 == NRFX_DRV_STATE_POWERED_ON)
- {
- m_state = NRFX_DRV_STATE_INITIALIZED;
- }
- nrf_comp_disable();
- nrf_comp_input_select(psel);
- if (comp_enable_state == true)
- {
- nrf_comp_enable();
- }
- }
- void nrfx_comp_start(uint32_t comp_int_mask, uint32_t comp_shorts_mask)
- {
- NRFX_ASSERT(m_state == NRFX_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 = NRFX_DRV_STATE_POWERED_ON;
- NRFX_LOG_INFO("Enabled.");
- }
- void nrfx_comp_stop(void)
- {
- NRFX_ASSERT(m_state == NRFX_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 = NRFX_DRV_STATE_INITIALIZED;
- NRFX_LOG_INFO("Disabled.");
- }
- uint32_t nrfx_comp_sample()
- {
- NRFX_ASSERT(m_state == NRFX_DRV_STATE_POWERED_ON);
- nrf_comp_task_trigger(NRF_COMP_TASK_SAMPLE);
- return nrf_comp_result_get();
- }
- #endif // NRFX_CHECK(NRFX_COMP_ENABLED)
|