123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366 |
- #include "sdk_common.h"
- #if NRF_MODULE_ENABLED(NRF_TWI_MNGR)
- #include "nrf_twi_mngr.h"
- #include "nrf_assert.h"
- #include "app_util_platform.h"
- typedef volatile struct
- {
- bool transaction_in_progress;
- uint8_t transaction_result;
- } nrf_twi_mngr_cb_data_t;
- static ret_code_t start_transfer(nrf_twi_mngr_t const * p_nrf_twi_mngr)
- {
- ASSERT(p_nrf_twi_mngr != NULL);
-
- nrf_twi_mngr_cb_t * p_cb = p_nrf_twi_mngr->p_nrf_twi_mngr_cb;
-
-
- uint8_t current_transfer_idx = p_cb->current_transfer_idx;
- nrf_twi_mngr_transfer_t const * p_transfer =
- &p_cb->p_current_transaction->p_transfers[current_transfer_idx];
- uint8_t address = NRF_TWI_MNGR_OP_ADDRESS(p_transfer->operation);
- nrf_drv_twi_xfer_desc_t xfer_desc;
- uint32_t flags;
- xfer_desc.address = address;
- xfer_desc.p_primary_buf = p_transfer->p_data;
- xfer_desc.primary_length = p_transfer->length;
-
- if ((p_transfer->flags & NRF_TWI_MNGR_NO_STOP) &&
- !NRF_TWI_MNGR_IS_READ_OP(p_transfer->operation) &&
-
- ((current_transfer_idx + 1) < p_cb->p_current_transaction->number_of_transfers) &&
- (NRF_TWI_MNGR_OP_ADDRESS(p_transfer->operation) ==
- NRF_TWI_MNGR_OP_ADDRESS(p_cb->p_current_transaction->
- p_transfers[current_transfer_idx + 1].operation)))
- {
- nrf_twi_mngr_transfer_t const * p_second_transfer =
- &p_cb->p_current_transaction->p_transfers[current_transfer_idx + 1];
- xfer_desc.p_secondary_buf = p_second_transfer->p_data;
- xfer_desc.secondary_length = p_second_transfer->length;
- xfer_desc.type = NRF_TWI_MNGR_IS_READ_OP(p_second_transfer->operation) ?
- NRF_DRV_TWI_XFER_TXRX : NRF_DRV_TWI_XFER_TXTX;
- flags = (p_second_transfer->flags & NRF_TWI_MNGR_NO_STOP) ? NRF_DRV_TWI_FLAG_TX_NO_STOP : 0;
- p_cb->current_transfer_idx++;
- }
- else
- {
- xfer_desc.type = NRF_TWI_MNGR_IS_READ_OP(p_transfer->operation) ? NRF_DRV_TWI_XFER_RX :
- NRF_DRV_TWI_XFER_TX;
- xfer_desc.p_secondary_buf = NULL;
- xfer_desc.secondary_length = 0;
- flags = (p_transfer->flags & NRF_TWI_MNGR_NO_STOP) ? NRF_DRV_TWI_FLAG_TX_NO_STOP : 0;
- }
- return nrf_drv_twi_xfer(&p_nrf_twi_mngr->twi, &xfer_desc, flags);
- }
- static void transaction_end_signal(nrf_twi_mngr_t const * p_nrf_twi_mngr,
- ret_code_t result)
- {
- ASSERT(p_nrf_twi_mngr != NULL);
- if (p_nrf_twi_mngr->p_nrf_twi_mngr_cb->p_current_transaction->callback)
- {
-
-
- void * p_user_data = p_nrf_twi_mngr->p_nrf_twi_mngr_cb->p_current_transaction->p_user_data;
- p_nrf_twi_mngr->p_nrf_twi_mngr_cb->p_current_transaction->callback(result, p_user_data);
- }
- }
- static void twi_event_handler(nrf_drv_twi_evt_t const * p_event,
- void * p_context);
- static void start_pending_transaction(nrf_twi_mngr_t const * p_nrf_twi_mngr,
- bool switch_transaction)
- {
- ASSERT(p_nrf_twi_mngr != NULL);
-
- nrf_twi_mngr_cb_t * p_cb = p_nrf_twi_mngr->p_nrf_twi_mngr_cb;
- for (;;)
- {
- bool start_transaction = false;
- CRITICAL_REGION_ENTER();
- if (switch_transaction || nrf_twi_mngr_is_idle(p_nrf_twi_mngr))
- {
- if (nrf_queue_pop(p_nrf_twi_mngr->p_queue, (void *)(&p_cb->p_current_transaction))
- == NRF_SUCCESS)
- {
- start_transaction = true;
- }
- else
- {
- p_cb->p_current_transaction = NULL;
- }
- }
- CRITICAL_REGION_EXIT();
- if (!start_transaction)
- {
- return;
- }
- else
- {
- ret_code_t result;
- nrf_drv_twi_config_t const * p_instance_cfg =
- p_cb->p_current_transaction->p_required_twi_cfg == NULL ?
- &p_cb->default_configuration :
- p_cb->p_current_transaction->p_required_twi_cfg;
- if (memcmp(p_cb->p_current_configuration, p_instance_cfg, sizeof(*p_instance_cfg)) != 0)
- {
- ret_code_t err_code;
- nrf_drv_twi_uninit(&p_nrf_twi_mngr->twi);
- err_code = nrf_drv_twi_init(&p_nrf_twi_mngr->twi,
- p_instance_cfg,
- twi_event_handler,
- (void *)p_nrf_twi_mngr);
- ASSERT(err_code == NRF_SUCCESS);
- nrf_drv_twi_enable(&p_nrf_twi_mngr->twi);
- UNUSED_VARIABLE(err_code);
- p_cb->p_current_configuration = p_instance_cfg;
- }
-
- p_cb->current_transfer_idx = 0;
- result = start_transfer(p_nrf_twi_mngr);
-
- if (result == NRF_SUCCESS)
- {
- return;
- }
-
-
-
- transaction_end_signal(p_nrf_twi_mngr, result);
- switch_transaction = true;
- }
- }
- }
- static void twi_event_handler(nrf_drv_twi_evt_t const * p_event,
- void * p_context)
- {
- ASSERT(p_event != NULL);
- nrf_twi_mngr_t * p_nrf_twi_mngr = (nrf_twi_mngr_t *)p_context;
- ret_code_t result;
-
- ASSERT(p_nrf_twi_mngr->p_nrf_twi_mngr_cb->p_current_transaction != NULL);
- if (p_event->type == NRF_DRV_TWI_EVT_DONE)
- {
- result = NRF_SUCCESS;
-
-
-
-
- uint8_t current_transfer_idx = p_nrf_twi_mngr->p_nrf_twi_mngr_cb->current_transfer_idx;
- ++current_transfer_idx;
- if (current_transfer_idx <
- p_nrf_twi_mngr->p_nrf_twi_mngr_cb->p_current_transaction->number_of_transfers)
- {
- p_nrf_twi_mngr->p_nrf_twi_mngr_cb->current_transfer_idx = current_transfer_idx;
- result = start_transfer(p_nrf_twi_mngr);
- if (result == NRF_SUCCESS)
- {
-
-
- return;
- }
-
-
- }
- }
- else
- {
- result = NRF_ERROR_INTERNAL;
- }
-
-
- transaction_end_signal(p_nrf_twi_mngr, result);
-
-
-
- start_pending_transaction(p_nrf_twi_mngr, true);
- }
- ret_code_t nrf_twi_mngr_init(nrf_twi_mngr_t const * p_nrf_twi_mngr,
- nrf_drv_twi_config_t const * p_default_twi_config)
- {
- ASSERT(p_nrf_twi_mngr != NULL);
- ASSERT(p_nrf_twi_mngr->p_queue != NULL);
- ASSERT(p_nrf_twi_mngr->p_queue->size > 0);
- ASSERT(p_default_twi_config != NULL);
- ret_code_t err_code;
- err_code = nrf_drv_twi_init(&p_nrf_twi_mngr->twi,
- p_default_twi_config,
- twi_event_handler,
- (void *)p_nrf_twi_mngr);
- VERIFY_SUCCESS(err_code);
- nrf_drv_twi_enable(&p_nrf_twi_mngr->twi);
- p_nrf_twi_mngr->p_nrf_twi_mngr_cb->p_current_transaction = NULL;
- p_nrf_twi_mngr->p_nrf_twi_mngr_cb->default_configuration = *p_default_twi_config;
- p_nrf_twi_mngr->p_nrf_twi_mngr_cb->p_current_configuration =
- &p_nrf_twi_mngr->p_nrf_twi_mngr_cb->default_configuration;
- return NRF_SUCCESS;
- }
- void nrf_twi_mngr_uninit(nrf_twi_mngr_t const * p_nrf_twi_mngr)
- {
- ASSERT(p_nrf_twi_mngr != NULL);
- nrf_drv_twi_uninit(&p_nrf_twi_mngr->twi);
- p_nrf_twi_mngr->p_nrf_twi_mngr_cb->p_current_transaction = NULL;
- }
- ret_code_t nrf_twi_mngr_schedule(nrf_twi_mngr_t const * p_nrf_twi_mngr,
- nrf_twi_mngr_transaction_t const * p_transaction)
- {
- ASSERT(p_nrf_twi_mngr != NULL);
- ASSERT(p_transaction != NULL);
- ASSERT(p_transaction->p_transfers != NULL);
- ASSERT(p_transaction->number_of_transfers != 0);
- ret_code_t result = NRF_SUCCESS;
- result = nrf_queue_push(p_nrf_twi_mngr->p_queue, (void *)(&p_transaction));
- if (result == NRF_SUCCESS)
- {
-
-
- start_pending_transaction(p_nrf_twi_mngr, false);
- }
- return result;
- }
- static void internal_transaction_cb(ret_code_t result, void * p_user_data)
- {
- nrf_twi_mngr_cb_data_t *p_cb_data = (nrf_twi_mngr_cb_data_t *)p_user_data;
- p_cb_data->transaction_result = result;
- p_cb_data->transaction_in_progress = false;
- }
- ret_code_t nrf_twi_mngr_perform(nrf_twi_mngr_t const * p_nrf_twi_mngr,
- nrf_drv_twi_config_t const * p_config,
- nrf_twi_mngr_transfer_t const * p_transfers,
- uint8_t number_of_transfers,
- void (* user_function)(void))
- {
- ASSERT(p_nrf_twi_mngr != NULL);
- ASSERT(p_transfers != NULL);
- ASSERT(number_of_transfers != 0);
- nrf_twi_mngr_cb_data_t cb_data =
- {
- .transaction_in_progress = true
- };
- nrf_twi_mngr_transaction_t internal_transaction =
- {
- .callback = internal_transaction_cb,
- .p_user_data = (void *)&cb_data,
- .p_transfers = p_transfers,
- .number_of_transfers = number_of_transfers,
- .p_required_twi_cfg = p_config
- };
- ret_code_t result = nrf_twi_mngr_schedule(p_nrf_twi_mngr, &internal_transaction);
- VERIFY_SUCCESS(result);
- while (cb_data.transaction_in_progress)
- {
- if (user_function)
- {
- user_function();
- }
- }
- return cb_data.transaction_result;
- }
- #endif
|