You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
252 lines
6.6 KiB
252 lines
6.6 KiB
/* |
|
* Copyright (c) 2025 MASSDRIVER EI (massdriver.space) |
|
* |
|
* SPDX-License-Identifier: Apache-2.0 |
|
*/ |
|
#define DT_DRV_COMPAT wch_spi |
|
|
|
#define LOG_LEVEL CONFIG_SPI_LOG_LEVEL |
|
#include <zephyr/logging/log.h> |
|
LOG_MODULE_REGISTER(spi_wch); |
|
|
|
#include "spi_context.h" |
|
#include <errno.h> |
|
#include <zephyr/device.h> |
|
#include <zephyr/drivers/spi.h> |
|
#include <zephyr/drivers/spi/rtio.h> |
|
#include <zephyr/drivers/pinctrl.h> |
|
#include <zephyr/drivers/clock_control.h> |
|
|
|
#include <hal_ch32fun.h> |
|
|
|
#define SPI_CTLR1_LSBFIRST BIT(7) |
|
#define SPI_CTLR1_BR_POS 3 |
|
|
|
struct spi_wch_config { |
|
SPI_TypeDef *regs; |
|
const struct pinctrl_dev_config *pin_cfg; |
|
const struct device *clk_dev; |
|
uint8_t clock_id; |
|
}; |
|
|
|
struct spi_wch_data { |
|
struct spi_context ctx; |
|
}; |
|
|
|
static uint8_t spi_wch_get_br(uint32_t target_clock_ratio) |
|
{ |
|
uint8_t prescaler; |
|
int prescaler_val = 2; |
|
|
|
for (prescaler = 0; prescaler < 7; prescaler++) { |
|
if (prescaler_val > target_clock_ratio) { |
|
break; |
|
} |
|
prescaler_val *= 2; |
|
} |
|
|
|
return prescaler; |
|
} |
|
|
|
static int spi_wch_configure(const struct device *dev, const struct spi_config *config) |
|
{ |
|
const struct spi_wch_config *cfg = dev->config; |
|
struct spi_wch_data *data = dev->data; |
|
SPI_TypeDef *regs = cfg->regs; |
|
int err; |
|
uint32_t clock_rate; |
|
clock_control_subsys_t clk_sys; |
|
int8_t prescaler; |
|
|
|
if (spi_context_configured(&data->ctx, config)) { |
|
return 0; |
|
} |
|
|
|
if ((config->operation & SPI_HALF_DUPLEX) != 0U) { |
|
LOG_ERR("Half-duplex not supported"); |
|
return -ENOTSUP; |
|
} |
|
|
|
if (SPI_OP_MODE_GET(config->operation) != SPI_OP_MODE_MASTER) { |
|
LOG_ERR("Slave mode not supported"); |
|
return -ENOTSUP; |
|
} |
|
|
|
if ((config->operation & SPI_MODE_LOOP) != 0U) { |
|
LOG_ERR("Loop mode not supported"); |
|
return -ENOTSUP; |
|
} |
|
|
|
if (SPI_WORD_SIZE_GET(config->operation) != 8) { |
|
LOG_ERR("Frame size != 8 bits not supported"); |
|
return -ENOTSUP; |
|
} |
|
|
|
regs->CTLR1 = 0; |
|
regs->CTLR2 = 0; |
|
regs->STATR = 0; |
|
|
|
if (spi_cs_is_gpio(config)) { |
|
/* When using soft NSS, SSI must be set high */ |
|
regs->CTLR1 |= SPI_CTLR1_SSM | SPI_CTLR1_SSI; |
|
} else { |
|
regs->CTLR2 |= SPI_CTLR2_SSOE; |
|
} |
|
|
|
regs->CTLR1 |= SPI_CTLR1_MSTR; |
|
|
|
if ((config->operation & SPI_TRANSFER_LSB) != 0U) { |
|
regs->CTLR1 |= SPI_CTLR1_LSBFIRST; |
|
} |
|
|
|
if ((config->operation & SPI_MODE_CPOL) != 0U) { |
|
regs->CTLR1 |= SPI_CTLR1_CPOL; |
|
} |
|
|
|
if ((config->operation & SPI_MODE_CPHA) != 0U) { |
|
regs->CTLR1 |= SPI_CTLR1_CPHA; |
|
} |
|
|
|
clk_sys = (clock_control_subsys_t)(uintptr_t)cfg->clock_id; |
|
err = clock_control_get_rate(cfg->clk_dev, clk_sys, &clock_rate); |
|
if (err != 0) { |
|
return err; |
|
} |
|
|
|
/* Approximate clock rate given ratios available */ |
|
prescaler = spi_wch_get_br(clock_rate / config->frequency); |
|
#if CONFIG_SPI_LOG_LEVEL >= LOG_LEVEL_INF |
|
uint32_t j = 2; |
|
|
|
for (int i = 0; i < prescaler; i++) { |
|
j = j * 2; |
|
} |
|
LOG_INF("Selected divider %d, value %d, results in %d frequency", j, prescaler, |
|
clock_rate / j); |
|
#endif |
|
regs->CTLR1 |= prescaler << SPI_CTLR1_BR_POS; |
|
|
|
data->ctx.config = config; |
|
|
|
return 0; |
|
} |
|
|
|
static int spi_wch_transceive(const struct device *dev, const struct spi_config *config, |
|
const struct spi_buf_set *tx_bufs, const struct spi_buf_set *rx_bufs) |
|
{ |
|
const struct spi_wch_config *cfg = dev->config; |
|
struct spi_wch_data *data = dev->data; |
|
SPI_TypeDef *regs = cfg->regs; |
|
int err; |
|
uint8_t rx; |
|
|
|
spi_context_lock(&data->ctx, false, NULL, NULL, config); |
|
|
|
err = spi_wch_configure(dev, config); |
|
if (err != 0) { |
|
goto done; |
|
} |
|
|
|
spi_context_buffers_setup(&data->ctx, tx_bufs, rx_bufs, 1); |
|
|
|
spi_context_cs_control(&data->ctx, true); |
|
|
|
/* Start SPI *AFTER* setting CS */ |
|
regs->CTLR1 |= SPI_CTLR1_SPE; |
|
|
|
while (spi_context_tx_on(&data->ctx) || spi_context_rx_on(&data->ctx)) { |
|
if (spi_context_tx_buf_on(&data->ctx)) { |
|
while ((regs->STATR & SPI_STATR_TXE) == 0U) { |
|
} |
|
regs->DATAR = *(uint8_t *)(data->ctx.tx_buf); |
|
} else { |
|
while ((regs->STATR & SPI_STATR_TXE) == 0U) { |
|
} |
|
regs->DATAR = 0; |
|
} |
|
spi_context_update_tx(&data->ctx, 1, 1); |
|
while ((regs->STATR & SPI_STATR_RXNE) == 0U) { |
|
} |
|
rx = regs->DATAR; |
|
if (spi_context_rx_buf_on(&data->ctx)) { |
|
*data->ctx.rx_buf = rx; |
|
} |
|
spi_context_update_rx(&data->ctx, 1, 1); |
|
} |
|
|
|
done: |
|
regs->CTLR1 &= ~(SPI_CTLR1_SPE); |
|
spi_context_cs_control(&data->ctx, false); |
|
spi_context_release(&data->ctx, err); |
|
return err; |
|
} |
|
|
|
static int spi_wch_transceive_sync(const struct device *dev, const struct spi_config *config, |
|
const struct spi_buf_set *tx_bufs, |
|
const struct spi_buf_set *rx_bufs) |
|
{ |
|
return spi_wch_transceive(dev, config, tx_bufs, rx_bufs); |
|
} |
|
|
|
static int spi_wch_release(const struct device *dev, const struct spi_config *config) |
|
{ |
|
struct spi_wch_data *data = dev->data; |
|
|
|
spi_context_unlock_unconditionally(&data->ctx); |
|
|
|
return 0; |
|
} |
|
|
|
static int spi_wch_init(const struct device *dev) |
|
{ |
|
int err; |
|
const struct spi_wch_config *cfg = dev->config; |
|
struct spi_wch_data *data = dev->data; |
|
clock_control_subsys_t clk_sys; |
|
|
|
clk_sys = (clock_control_subsys_t)(uintptr_t)cfg->clock_id; |
|
|
|
err = clock_control_on(cfg->clk_dev, clk_sys); |
|
if (err < 0) { |
|
return err; |
|
} |
|
|
|
err = pinctrl_apply_state(cfg->pin_cfg, PINCTRL_STATE_DEFAULT); |
|
if (err < 0) { |
|
return err; |
|
} |
|
|
|
err = spi_context_cs_configure_all(&data->ctx); |
|
if (err < 0) { |
|
return err; |
|
} |
|
|
|
spi_context_unlock_unconditionally(&data->ctx); |
|
|
|
return 0; |
|
} |
|
|
|
static DEVICE_API(spi, spi_wch_driver_api) = { |
|
.transceive = spi_wch_transceive_sync, |
|
#ifdef CONFIG_SPI_RTIO |
|
.iodev_submit = spi_rtio_iodev_default_submit, |
|
#endif |
|
.release = spi_wch_release, |
|
}; |
|
|
|
#define SPI_WCH_DEVICE_INIT(n) \ |
|
PINCTRL_DT_INST_DEFINE(n); \ |
|
static const struct spi_wch_config spi_wch_config_##n = { \ |
|
.regs = (SPI_TypeDef *)DT_INST_REG_ADDR(n), \ |
|
.clk_dev = DEVICE_DT_GET(DT_INST_CLOCKS_CTLR(n)), \ |
|
.pin_cfg = PINCTRL_DT_INST_DEV_CONFIG_GET(n), \ |
|
.clock_id = DT_INST_CLOCKS_CELL(n, id)}; \ |
|
static struct spi_wch_data spi_wch_dev_data_##n = { \ |
|
SPI_CONTEXT_INIT_LOCK(spi_wch_dev_data_##n, ctx), \ |
|
SPI_CONTEXT_INIT_SYNC(spi_wch_dev_data_##n, ctx), \ |
|
SPI_CONTEXT_CS_GPIOS_INITIALIZE(DT_DRV_INST(n), ctx)}; \ |
|
SPI_DEVICE_DT_INST_DEFINE(n, spi_wch_init, NULL, &spi_wch_dev_data_##n, \ |
|
&spi_wch_config_##n, POST_KERNEL, CONFIG_SPI_INIT_PRIORITY, \ |
|
&spi_wch_driver_api); |
|
|
|
DT_INST_FOREACH_STATUS_OKAY(SPI_WCH_DEVICE_INIT)
|
|
|