359 lines
9.2 KiB
C
359 lines
9.2 KiB
C
/*
|
|
* Copyright (c) 2017 - 2018, Nordic Semiconductor ASA
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
#include <spi.h>
|
|
#include <nrfx_spim.h>
|
|
#include <string.h>
|
|
|
|
#define SYS_LOG_DOMAIN "spi_nrfx_spim"
|
|
#define SYS_LOG_LEVEL CONFIG_SYS_LOG_SPI_LEVEL
|
|
#include <logging/sys_log.h>
|
|
|
|
#include "spi_context.h"
|
|
|
|
struct spi_nrfx_data {
|
|
struct spi_context ctx;
|
|
size_t chunk_len;
|
|
bool busy;
|
|
#if (CONFIG_SPI_NRFX_RAM_BUFFER_SIZE > 0)
|
|
u8_t buffer[CONFIG_SPI_NRFX_RAM_BUFFER_SIZE];
|
|
#endif
|
|
};
|
|
|
|
struct spi_nrfx_config {
|
|
nrfx_spim_t spim;
|
|
size_t max_chunk_len;
|
|
};
|
|
|
|
static inline struct spi_nrfx_data *get_dev_data(struct device *dev)
|
|
{
|
|
return dev->driver_data;
|
|
}
|
|
|
|
static inline const struct spi_nrfx_config *get_dev_config(struct device *dev)
|
|
{
|
|
return dev->config->config_info;
|
|
}
|
|
|
|
static inline nrf_spim_frequency_t get_nrf_spim_frequency(u32_t frequency)
|
|
{
|
|
/* Get the highest supported frequency not exceeding the requested one.
|
|
*/
|
|
if (frequency < 250000) {
|
|
return NRF_SPIM_FREQ_125K;
|
|
} else if (frequency < 500000) {
|
|
return NRF_SPIM_FREQ_250K;
|
|
} else if (frequency < 1000000) {
|
|
return NRF_SPIM_FREQ_500K;
|
|
} else if (frequency < 2000000) {
|
|
return NRF_SPIM_FREQ_1M;
|
|
} else if (frequency < 4000000) {
|
|
return NRF_SPIM_FREQ_2M;
|
|
} else if (frequency < 8000000) {
|
|
return NRF_SPIM_FREQ_4M;
|
|
#ifdef CONFIG_SOC_NRF52840
|
|
} else if (frequency < 16000000) {
|
|
return NRF_SPIM_FREQ_8M;
|
|
} else if (frequency < 32000000) {
|
|
return NRF_SPIM_FREQ_16M;
|
|
} else {
|
|
return NRF_SPIM_FREQ_32M;
|
|
#else
|
|
} else {
|
|
return NRF_SPIM_FREQ_8M;
|
|
#endif
|
|
}
|
|
}
|
|
|
|
static inline nrf_spim_mode_t get_nrf_spim_mode(u16_t operation)
|
|
{
|
|
if (SPI_MODE_GET(operation) & SPI_MODE_CPOL) {
|
|
if (SPI_MODE_GET(operation) & SPI_MODE_CPHA) {
|
|
return NRF_SPIM_MODE_3;
|
|
} else {
|
|
return NRF_SPIM_MODE_2;
|
|
}
|
|
} else {
|
|
if (SPI_MODE_GET(operation) & SPI_MODE_CPHA) {
|
|
return NRF_SPIM_MODE_1;
|
|
} else {
|
|
return NRF_SPIM_MODE_0;
|
|
}
|
|
}
|
|
}
|
|
|
|
static inline nrf_spim_bit_order_t get_nrf_spim_bit_order(u16_t operation)
|
|
{
|
|
if (operation & SPI_TRANSFER_LSB) {
|
|
return NRF_SPIM_BIT_ORDER_LSB_FIRST;
|
|
} else {
|
|
return NRF_SPIM_BIT_ORDER_MSB_FIRST;
|
|
}
|
|
}
|
|
|
|
static int configure(struct device *dev,
|
|
const struct spi_config *spi_cfg)
|
|
{
|
|
struct spi_context *ctx = &get_dev_data(dev)->ctx;
|
|
const nrfx_spim_t *spim = &get_dev_config(dev)->spim;
|
|
|
|
if (spi_context_configured(ctx, spi_cfg)) {
|
|
/* Already configured. No need to do it again. */
|
|
return 0;
|
|
}
|
|
|
|
if (SPI_OP_MODE_GET(spi_cfg->operation) != SPI_OP_MODE_MASTER) {
|
|
SYS_LOG_ERR("Slave mode is not supported on %s",
|
|
dev->config->name);
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (spi_cfg->operation & SPI_MODE_LOOP) {
|
|
SYS_LOG_ERR("Loopback mode is not supported");
|
|
return -EINVAL;
|
|
}
|
|
|
|
if ((spi_cfg->operation & SPI_LINES_MASK) != SPI_LINES_SINGLE) {
|
|
SYS_LOG_ERR("Only single line mode is supported");
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (SPI_WORD_SIZE_GET(spi_cfg->operation) != 8) {
|
|
SYS_LOG_ERR("Word sizes other than 8 bits"
|
|
" are not supported");
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (spi_cfg->frequency < 125000) {
|
|
SYS_LOG_ERR("Frequencies lower than 125 kHz are not supported");
|
|
return -EINVAL;
|
|
}
|
|
|
|
ctx->config = spi_cfg;
|
|
spi_context_cs_configure(ctx);
|
|
|
|
nrf_spim_configure(spim->p_reg,
|
|
get_nrf_spim_mode(spi_cfg->operation),
|
|
get_nrf_spim_bit_order(spi_cfg->operation));
|
|
nrf_spim_frequency_set(spim->p_reg,
|
|
get_nrf_spim_frequency(spi_cfg->frequency));
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void transfer_next_chunk(struct device *dev)
|
|
{
|
|
struct spi_nrfx_data *dev_data = get_dev_data(dev);
|
|
const struct spi_nrfx_config *dev_config = get_dev_config(dev);
|
|
struct spi_context *ctx = &dev_data->ctx;
|
|
int error = 0;
|
|
|
|
size_t chunk_len = spi_context_longest_current_buf(ctx);
|
|
|
|
if (chunk_len > 0) {
|
|
nrfx_spim_xfer_desc_t xfer;
|
|
nrfx_err_t result;
|
|
const u8_t *tx_buf = ctx->tx_buf;
|
|
#if (CONFIG_SPI_NRFX_RAM_BUFFER_SIZE > 0)
|
|
if (spi_context_tx_buf_on(ctx) && !nrfx_is_in_ram(tx_buf)) {
|
|
if (chunk_len > sizeof(dev_data->buffer)) {
|
|
chunk_len = sizeof(dev_data->buffer);
|
|
}
|
|
|
|
memcpy(dev_data->buffer, tx_buf, chunk_len);
|
|
tx_buf = dev_data->buffer;
|
|
}
|
|
#endif
|
|
if (chunk_len > dev_config->max_chunk_len) {
|
|
chunk_len = dev_config->max_chunk_len;
|
|
}
|
|
|
|
dev_data->chunk_len = chunk_len;
|
|
|
|
xfer.p_tx_buffer = tx_buf;
|
|
xfer.tx_length = spi_context_tx_buf_on(ctx) ? chunk_len : 0;
|
|
xfer.p_rx_buffer = ctx->rx_buf;
|
|
xfer.rx_length = spi_context_rx_buf_on(ctx) ? chunk_len : 0;
|
|
result = nrfx_spim_xfer(&dev_config->spim, &xfer, 0);
|
|
if (result == NRFX_SUCCESS) {
|
|
return;
|
|
}
|
|
|
|
error = -EIO;
|
|
}
|
|
|
|
spi_context_cs_control(ctx, false);
|
|
|
|
SYS_LOG_DBG("Transaction finished with status %d", error);
|
|
|
|
spi_context_complete(ctx, error);
|
|
dev_data->busy = false;
|
|
}
|
|
|
|
static int transceive(struct device *dev,
|
|
const struct spi_config *spi_cfg,
|
|
const struct spi_buf_set *tx_bufs,
|
|
const struct spi_buf_set *rx_bufs)
|
|
{
|
|
struct spi_nrfx_data *dev_data = get_dev_data(dev);
|
|
int error;
|
|
|
|
error = configure(dev, spi_cfg);
|
|
if (error == 0) {
|
|
dev_data->busy = true;
|
|
|
|
spi_context_buffers_setup(&dev_data->ctx, tx_bufs, rx_bufs, 1);
|
|
spi_context_cs_control(&dev_data->ctx, true);
|
|
|
|
transfer_next_chunk(dev);
|
|
|
|
error = spi_context_wait_for_completion(&dev_data->ctx);
|
|
}
|
|
|
|
spi_context_release(&dev_data->ctx, error);
|
|
|
|
return error;
|
|
}
|
|
|
|
static int spi_nrfx_transceive(struct device *dev,
|
|
const struct spi_config *spi_cfg,
|
|
const struct spi_buf_set *tx_bufs,
|
|
const struct spi_buf_set *rx_bufs)
|
|
{
|
|
spi_context_lock(&get_dev_data(dev)->ctx, false, NULL);
|
|
return transceive(dev, spi_cfg, tx_bufs, rx_bufs);
|
|
}
|
|
|
|
#ifdef CONFIG_SPI_ASYNC
|
|
static int spi_nrfx_transceive_async(struct device *dev,
|
|
const struct spi_config *spi_cfg,
|
|
const struct spi_buf_set *tx_bufs,
|
|
const struct spi_buf_set *rx_bufs,
|
|
struct k_poll_signal *async)
|
|
{
|
|
spi_context_lock(&get_dev_data(dev)->ctx, true, async);
|
|
return transceive(dev, spi_cfg, tx_bufs, rx_bufs);
|
|
}
|
|
#endif /* CONFIG_SPI_ASYNC */
|
|
|
|
static int spi_nrfx_release(struct device *dev,
|
|
const struct spi_config *spi_cfg)
|
|
{
|
|
struct spi_nrfx_data *dev_data = get_dev_data(dev);
|
|
|
|
if (!spi_context_configured(&dev_data->ctx, spi_cfg)) {
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (dev_data->busy) {
|
|
return -EBUSY;
|
|
}
|
|
|
|
spi_context_unlock_unconditionally(&dev_data->ctx);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct spi_driver_api spi_nrfx_driver_api = {
|
|
.transceive = spi_nrfx_transceive,
|
|
#ifdef CONFIG_SPI_ASYNC
|
|
.transceive_async = spi_nrfx_transceive_async,
|
|
#endif
|
|
.release = spi_nrfx_release,
|
|
};
|
|
|
|
|
|
static void event_handler(const nrfx_spim_evt_t *p_event, void *p_context)
|
|
{
|
|
struct device *dev = p_context;
|
|
struct spi_nrfx_data *dev_data = get_dev_data(dev);
|
|
|
|
if (p_event->type == NRFX_SPIM_EVENT_DONE) {
|
|
spi_context_update_tx(&dev_data->ctx, 1, dev_data->chunk_len);
|
|
spi_context_update_rx(&dev_data->ctx, 1, dev_data->chunk_len);
|
|
|
|
transfer_next_chunk(dev);
|
|
}
|
|
}
|
|
|
|
static int init_spim(struct device *dev, const nrfx_spim_config_t *config)
|
|
{
|
|
/* This sets only default values of frequency, mode and bit order.
|
|
* The proper ones are set in configure() when a transfer is started.
|
|
*/
|
|
nrfx_err_t result = nrfx_spim_init(&get_dev_config(dev)->spim,
|
|
config,
|
|
event_handler,
|
|
dev);
|
|
if (result != NRFX_SUCCESS) {
|
|
SYS_LOG_ERR("Failed to initialize device: %s",
|
|
dev->config->name);
|
|
return -EBUSY;
|
|
}
|
|
|
|
spi_context_unlock_unconditionally(&get_dev_data(dev)->ctx);
|
|
|
|
return 0;
|
|
}
|
|
|
|
#if NRFX_CHECK(NRFX_SPIM_EXTENDED_ENABLED)
|
|
#define SPI_NRFX_SPIM_EXTENDED_CONFIG(idx) \
|
|
.rx_delay = CONFIG_SPI_##idx##_NRF_RX_DELAY,
|
|
#else
|
|
#define SPI_NRFX_SPIM_EXTENDED_CONFIG(idx)
|
|
#endif
|
|
|
|
#define SPI_NRFX_SPIM_DEVICE(idx) \
|
|
static int spi_##idx##_init(struct device *dev) \
|
|
{ \
|
|
IRQ_CONNECT(NRFX_IRQ_NUMBER_GET(NRF_SPIM##idx), \
|
|
CONFIG_SPI_##idx##_IRQ_PRI, \
|
|
nrfx_isr, nrfx_spim_##idx##_irq_handler, 0); \
|
|
const nrfx_spim_config_t config = { \
|
|
.sck_pin = CONFIG_SPI_##idx##_NRF_SCK_PIN, \
|
|
.mosi_pin = CONFIG_SPI_##idx##_NRF_MOSI_PIN, \
|
|
.miso_pin = CONFIG_SPI_##idx##_NRF_MISO_PIN, \
|
|
.ss_pin = NRFX_SPIM_PIN_NOT_USED, \
|
|
.orc = CONFIG_SPI_##idx##_NRF_ORC, \
|
|
.frequency = NRF_SPIM_FREQ_4M, \
|
|
.mode = NRF_SPIM_MODE_0, \
|
|
.bit_order = NRF_SPIM_BIT_ORDER_MSB_FIRST, \
|
|
SPI_NRFX_SPIM_EXTENDED_CONFIG(idx) \
|
|
}; \
|
|
return init_spim(dev, &config); \
|
|
} \
|
|
static struct spi_nrfx_data spi_##idx##_data = { \
|
|
SPI_CONTEXT_INIT_LOCK(spi_##idx##_data, ctx), \
|
|
SPI_CONTEXT_INIT_SYNC(spi_##idx##_data, ctx), \
|
|
.busy = false, \
|
|
}; \
|
|
static const struct spi_nrfx_config spi_##idx##_config = { \
|
|
.spim = NRFX_SPIM_INSTANCE(idx), \
|
|
.max_chunk_len = (1 << SPIM##idx##_EASYDMA_MAXCNT_SIZE) - 1, \
|
|
}; \
|
|
DEVICE_AND_API_INIT(spi_##idx, CONFIG_SPI_##idx##_NAME, \
|
|
spi_##idx##_init, \
|
|
&spi_##idx##_data, \
|
|
&spi_##idx##_config, \
|
|
POST_KERNEL, CONFIG_SPI_INIT_PRIORITY, \
|
|
&spi_nrfx_driver_api)
|
|
|
|
#ifdef CONFIG_SPI_0_NRF_SPIM
|
|
SPI_NRFX_SPIM_DEVICE(0);
|
|
#endif
|
|
|
|
#ifdef CONFIG_SPI_1_NRF_SPIM
|
|
SPI_NRFX_SPIM_DEVICE(1);
|
|
#endif
|
|
|
|
#ifdef CONFIG_SPI_2_NRF_SPIM
|
|
SPI_NRFX_SPIM_DEVICE(2);
|
|
#endif
|
|
|
|
#ifdef CONFIG_SPI_3_NRF_SPIM
|
|
SPI_NRFX_SPIM_DEVICE(3);
|
|
#endif
|