922 lines
23 KiB
C
922 lines
23 KiB
C
/*
|
|
* Copyright (c) 2023 Jeroen van Dooren, Nobleo Technology
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
/**
|
|
* @brief Common part of BDMA drivers for stm32.
|
|
*/
|
|
|
|
#include "dma_stm32_bdma.h"
|
|
|
|
#include <zephyr/init.h>
|
|
#include <zephyr/drivers/clock_control.h>
|
|
#include <zephyr/drivers/dma/dma_stm32.h>
|
|
#include <zephyr/dt-bindings/memory-attr/memory-attr-arm.h>
|
|
|
|
#include <zephyr/logging/log.h>
|
|
#include <zephyr/irq.h>
|
|
LOG_MODULE_REGISTER(dma_stm32_bdma, CONFIG_DMA_LOG_LEVEL);
|
|
|
|
#define DT_DRV_COMPAT st_stm32_bdma
|
|
|
|
#define BDMA_STM32_0_CHANNEL_COUNT 8
|
|
|
|
static const uint32_t table_m_size[] = {
|
|
LL_BDMA_MDATAALIGN_BYTE,
|
|
LL_BDMA_MDATAALIGN_HALFWORD,
|
|
LL_BDMA_MDATAALIGN_WORD,
|
|
};
|
|
|
|
static const uint32_t table_p_size[] = {
|
|
LL_BDMA_PDATAALIGN_BYTE,
|
|
LL_BDMA_PDATAALIGN_HALFWORD,
|
|
LL_BDMA_PDATAALIGN_WORD,
|
|
};
|
|
|
|
uint32_t bdma_stm32_id_to_channel(uint32_t id)
|
|
{
|
|
static const uint32_t channel_nr[] = {
|
|
LL_BDMA_CHANNEL_0,
|
|
LL_BDMA_CHANNEL_1,
|
|
LL_BDMA_CHANNEL_2,
|
|
LL_BDMA_CHANNEL_3,
|
|
LL_BDMA_CHANNEL_4,
|
|
LL_BDMA_CHANNEL_5,
|
|
LL_BDMA_CHANNEL_6,
|
|
LL_BDMA_CHANNEL_7,
|
|
};
|
|
|
|
__ASSERT_NO_MSG(id < ARRAY_SIZE(channel_nr));
|
|
|
|
return channel_nr[id];
|
|
}
|
|
|
|
#if !defined(CONFIG_DMAMUX_STM32)
|
|
uint32_t bdma_stm32_slot_to_channel(uint32_t slot)
|
|
{
|
|
static const uint32_t channel_nr[] = {
|
|
LL_BDMA_CHANNEL_0,
|
|
LL_BDMA_CHANNEL_1,
|
|
LL_BDMA_CHANNEL_2,
|
|
LL_BDMA_CHANNEL_3,
|
|
LL_BDMA_CHANNEL_4,
|
|
LL_BDMA_CHANNEL_5,
|
|
LL_BDMA_CHANNEL_6,
|
|
LL_BDMA_CHANNEL_7,
|
|
};
|
|
|
|
__ASSERT_NO_MSG(slot < ARRAY_SIZE(channel_nr));
|
|
|
|
return channel_nr[slot];
|
|
}
|
|
#endif
|
|
|
|
void bdma_stm32_clear_ht(BDMA_TypeDef *DMAx, uint32_t id)
|
|
{
|
|
static const bdma_stm32_clear_flag_func func[] = {
|
|
LL_BDMA_ClearFlag_HT0,
|
|
LL_BDMA_ClearFlag_HT1,
|
|
LL_BDMA_ClearFlag_HT2,
|
|
LL_BDMA_ClearFlag_HT3,
|
|
LL_BDMA_ClearFlag_HT4,
|
|
LL_BDMA_ClearFlag_HT5,
|
|
LL_BDMA_ClearFlag_HT6,
|
|
LL_BDMA_ClearFlag_HT7,
|
|
};
|
|
|
|
__ASSERT_NO_MSG(id < ARRAY_SIZE(func));
|
|
|
|
func[id](DMAx);
|
|
}
|
|
|
|
void bdma_stm32_clear_tc(BDMA_TypeDef *DMAx, uint32_t id)
|
|
{
|
|
static const bdma_stm32_clear_flag_func func[] = {
|
|
LL_BDMA_ClearFlag_TC0,
|
|
LL_BDMA_ClearFlag_TC1,
|
|
LL_BDMA_ClearFlag_TC2,
|
|
LL_BDMA_ClearFlag_TC3,
|
|
LL_BDMA_ClearFlag_TC4,
|
|
LL_BDMA_ClearFlag_TC5,
|
|
LL_BDMA_ClearFlag_TC6,
|
|
LL_BDMA_ClearFlag_TC7,
|
|
};
|
|
|
|
__ASSERT_NO_MSG(id < ARRAY_SIZE(func));
|
|
|
|
func[id](DMAx);
|
|
}
|
|
|
|
bool bdma_stm32_is_ht_active(BDMA_TypeDef *DMAx, uint32_t id)
|
|
{
|
|
static const bdma_stm32_check_flag_func func[] = {
|
|
LL_BDMA_IsActiveFlag_HT0,
|
|
LL_BDMA_IsActiveFlag_HT1,
|
|
LL_BDMA_IsActiveFlag_HT2,
|
|
LL_BDMA_IsActiveFlag_HT3,
|
|
LL_BDMA_IsActiveFlag_HT4,
|
|
LL_BDMA_IsActiveFlag_HT5,
|
|
LL_BDMA_IsActiveFlag_HT6,
|
|
LL_BDMA_IsActiveFlag_HT7,
|
|
};
|
|
|
|
__ASSERT_NO_MSG(id < ARRAY_SIZE(func));
|
|
|
|
return func[id](DMAx);
|
|
}
|
|
|
|
bool bdma_stm32_is_tc_active(BDMA_TypeDef *DMAx, uint32_t id)
|
|
{
|
|
static const bdma_stm32_check_flag_func func[] = {
|
|
LL_BDMA_IsActiveFlag_TC0,
|
|
LL_BDMA_IsActiveFlag_TC1,
|
|
LL_BDMA_IsActiveFlag_TC2,
|
|
LL_BDMA_IsActiveFlag_TC3,
|
|
LL_BDMA_IsActiveFlag_TC4,
|
|
LL_BDMA_IsActiveFlag_TC5,
|
|
LL_BDMA_IsActiveFlag_TC6,
|
|
LL_BDMA_IsActiveFlag_TC7,
|
|
};
|
|
|
|
__ASSERT_NO_MSG(id < ARRAY_SIZE(func));
|
|
|
|
return func[id](DMAx);
|
|
}
|
|
|
|
void bdma_stm32_clear_te(BDMA_TypeDef *DMAx, uint32_t id)
|
|
{
|
|
static const bdma_stm32_clear_flag_func func[] = {
|
|
LL_BDMA_ClearFlag_TE0,
|
|
LL_BDMA_ClearFlag_TE1,
|
|
LL_BDMA_ClearFlag_TE2,
|
|
LL_BDMA_ClearFlag_TE3,
|
|
LL_BDMA_ClearFlag_TE4,
|
|
LL_BDMA_ClearFlag_TE5,
|
|
LL_BDMA_ClearFlag_TE6,
|
|
LL_BDMA_ClearFlag_TE7,
|
|
};
|
|
|
|
__ASSERT_NO_MSG(id < ARRAY_SIZE(func));
|
|
|
|
func[id](DMAx);
|
|
}
|
|
|
|
void bdma_stm32_clear_gi(BDMA_TypeDef *DMAx, uint32_t id)
|
|
{
|
|
static const bdma_stm32_clear_flag_func func[] = {
|
|
LL_BDMA_ClearFlag_GI0,
|
|
LL_BDMA_ClearFlag_GI1,
|
|
LL_BDMA_ClearFlag_GI2,
|
|
LL_BDMA_ClearFlag_GI3,
|
|
LL_BDMA_ClearFlag_GI4,
|
|
LL_BDMA_ClearFlag_GI5,
|
|
LL_BDMA_ClearFlag_GI6,
|
|
LL_BDMA_ClearFlag_GI7,
|
|
};
|
|
|
|
__ASSERT_NO_MSG(id < ARRAY_SIZE(func));
|
|
|
|
func[id](DMAx);
|
|
}
|
|
|
|
bool bdma_stm32_is_te_active(BDMA_TypeDef *DMAx, uint32_t id)
|
|
{
|
|
static const bdma_stm32_check_flag_func func[] = {
|
|
LL_BDMA_IsActiveFlag_TE0,
|
|
LL_BDMA_IsActiveFlag_TE1,
|
|
LL_BDMA_IsActiveFlag_TE2,
|
|
LL_BDMA_IsActiveFlag_TE3,
|
|
LL_BDMA_IsActiveFlag_TE4,
|
|
LL_BDMA_IsActiveFlag_TE5,
|
|
LL_BDMA_IsActiveFlag_TE6,
|
|
LL_BDMA_IsActiveFlag_TE7,
|
|
};
|
|
|
|
__ASSERT_NO_MSG(id < ARRAY_SIZE(func));
|
|
|
|
return func[id](DMAx);
|
|
}
|
|
|
|
bool bdma_stm32_is_gi_active(BDMA_TypeDef *DMAx, uint32_t id)
|
|
{
|
|
static const bdma_stm32_check_flag_func func[] = {
|
|
LL_BDMA_IsActiveFlag_GI0,
|
|
LL_BDMA_IsActiveFlag_GI1,
|
|
LL_BDMA_IsActiveFlag_GI2,
|
|
LL_BDMA_IsActiveFlag_GI3,
|
|
LL_BDMA_IsActiveFlag_GI4,
|
|
LL_BDMA_IsActiveFlag_GI5,
|
|
LL_BDMA_IsActiveFlag_GI6,
|
|
LL_BDMA_IsActiveFlag_GI7,
|
|
};
|
|
|
|
__ASSERT_NO_MSG(id < ARRAY_SIZE(func));
|
|
|
|
return func[id](DMAx);
|
|
}
|
|
|
|
void stm32_bdma_dump_channel_irq(BDMA_TypeDef *dma, uint32_t id)
|
|
{
|
|
LOG_INF("te: %d, ht: %d, tc: %d, gi: %d",
|
|
bdma_stm32_is_te_active(dma, id),
|
|
bdma_stm32_is_ht_active(dma, id),
|
|
bdma_stm32_is_tc_active(dma, id),
|
|
bdma_stm32_is_gi_active(dma, id));
|
|
}
|
|
|
|
inline bool stm32_bdma_is_tc_irq_active(BDMA_TypeDef *dma, uint32_t id)
|
|
{
|
|
return LL_BDMA_IsEnabledIT_TC(dma, bdma_stm32_id_to_channel(id)) &&
|
|
bdma_stm32_is_tc_active(dma, id);
|
|
}
|
|
|
|
inline bool stm32_bdma_is_ht_irq_active(BDMA_TypeDef *dma, uint32_t id)
|
|
{
|
|
return LL_BDMA_IsEnabledIT_HT(dma, bdma_stm32_id_to_channel(id)) &&
|
|
bdma_stm32_is_ht_active(dma, id);
|
|
}
|
|
|
|
static inline bool stm32_bdma_is_te_irq_active(BDMA_TypeDef *dma, uint32_t id)
|
|
{
|
|
return LL_BDMA_IsEnabledIT_TE(dma, bdma_stm32_id_to_channel(id)) &&
|
|
bdma_stm32_is_te_active(dma, id);
|
|
}
|
|
|
|
bool stm32_bdma_is_irq_active(BDMA_TypeDef *dma, uint32_t id)
|
|
{
|
|
return stm32_bdma_is_tc_irq_active(dma, id) ||
|
|
stm32_bdma_is_ht_irq_active(dma, id) ||
|
|
stm32_bdma_is_te_irq_active(dma, id);
|
|
}
|
|
|
|
void stm32_bdma_clear_channel_irq(BDMA_TypeDef *dma, uint32_t id)
|
|
{
|
|
bdma_stm32_clear_gi(dma, id);
|
|
bdma_stm32_clear_tc(dma, id);
|
|
bdma_stm32_clear_ht(dma, id);
|
|
bdma_stm32_clear_te(dma, id);
|
|
}
|
|
|
|
bool stm32_bdma_is_enabled_channel(BDMA_TypeDef *dma, uint32_t id)
|
|
{
|
|
if (LL_BDMA_IsEnabledChannel(dma, bdma_stm32_id_to_channel(id)) == 1) {
|
|
return true;
|
|
}
|
|
return false;
|
|
}
|
|
|
|
int stm32_bdma_disable_channel(BDMA_TypeDef *dma, uint32_t id)
|
|
{
|
|
LL_BDMA_DisableChannel(dma, bdma_stm32_id_to_channel(id));
|
|
|
|
if (!LL_BDMA_IsEnabledChannel(dma, bdma_stm32_id_to_channel(id))) {
|
|
return 0;
|
|
}
|
|
|
|
return -EAGAIN;
|
|
}
|
|
|
|
void stm32_bdma_enable_channel(BDMA_TypeDef *dma, uint32_t id)
|
|
{
|
|
LL_BDMA_EnableChannel(dma, bdma_stm32_id_to_channel(id));
|
|
}
|
|
|
|
static void bdma_stm32_dump_channel_irq(const struct device *dev, uint32_t id)
|
|
{
|
|
const struct bdma_stm32_config *config = dev->config;
|
|
BDMA_TypeDef *dma = (BDMA_TypeDef *)(config->base);
|
|
|
|
stm32_bdma_dump_channel_irq(dma, id);
|
|
}
|
|
|
|
static void bdma_stm32_clear_channel_irq(const struct device *dev, uint32_t id)
|
|
{
|
|
const struct bdma_stm32_config *config = dev->config;
|
|
BDMA_TypeDef *dma = (BDMA_TypeDef *)(config->base);
|
|
|
|
bdma_stm32_clear_tc(dma, id);
|
|
bdma_stm32_clear_ht(dma, id);
|
|
stm32_bdma_clear_channel_irq(dma, id);
|
|
}
|
|
|
|
static void bdma_stm32_irq_handler(const struct device *dev, uint32_t id)
|
|
{
|
|
const struct bdma_stm32_config *config = dev->config;
|
|
BDMA_TypeDef *dma = (BDMA_TypeDef *)(config->base);
|
|
struct bdma_stm32_channel *channel;
|
|
uint32_t callback_arg;
|
|
|
|
__ASSERT_NO_MSG(id < config->max_channels);
|
|
|
|
channel = &config->channels[id];
|
|
|
|
/* The busy channel is pertinent if not overridden by the HAL */
|
|
if ((channel->hal_override != true) && (channel->busy == false)) {
|
|
/*
|
|
* When DMA channel is not overridden by HAL,
|
|
* ignore irq if the channel is not busy anymore
|
|
*/
|
|
bdma_stm32_clear_channel_irq(dev, id);
|
|
return;
|
|
}
|
|
|
|
#ifdef CONFIG_DMAMUX_STM32
|
|
callback_arg = channel->mux_channel;
|
|
#else
|
|
callback_arg = id;
|
|
#endif /* CONFIG_DMAMUX_STM32 */
|
|
|
|
if (!IS_ENABLED(CONFIG_DMAMUX_STM32)) {
|
|
channel->busy = false;
|
|
}
|
|
|
|
/* the dma channel id is in range from 0..<dma-requests> */
|
|
if (stm32_bdma_is_ht_irq_active(dma, id)) {
|
|
/* Let HAL DMA handle flags on its own */
|
|
if (!channel->hal_override) {
|
|
bdma_stm32_clear_ht(dma, id);
|
|
}
|
|
channel->bdma_callback(dev, channel->user_data, callback_arg, 0);
|
|
} else if (stm32_bdma_is_tc_irq_active(dma, id)) {
|
|
#ifdef CONFIG_DMAMUX_STM32
|
|
channel->busy = false;
|
|
#endif
|
|
/* Let HAL DMA handle flags on its own */
|
|
if (!channel->hal_override) {
|
|
bdma_stm32_clear_tc(dma, id);
|
|
}
|
|
channel->bdma_callback(dev, channel->user_data, callback_arg, 0);
|
|
} else {
|
|
LOG_ERR("Transfer Error.");
|
|
bdma_stm32_dump_channel_irq(dev, id);
|
|
bdma_stm32_clear_channel_irq(dev, id);
|
|
channel->bdma_callback(dev, channel->user_data,
|
|
callback_arg, -EIO);
|
|
}
|
|
}
|
|
|
|
static int bdma_stm32_get_priority(uint8_t priority, uint32_t *ll_priority)
|
|
{
|
|
switch (priority) {
|
|
case 0x0:
|
|
*ll_priority = LL_BDMA_PRIORITY_LOW;
|
|
break;
|
|
case 0x1:
|
|
*ll_priority = LL_BDMA_PRIORITY_MEDIUM;
|
|
break;
|
|
case 0x2:
|
|
*ll_priority = LL_BDMA_PRIORITY_HIGH;
|
|
break;
|
|
case 0x3:
|
|
*ll_priority = LL_BDMA_PRIORITY_VERYHIGH;
|
|
break;
|
|
default:
|
|
LOG_ERR("Priority error. %d", priority);
|
|
return -EINVAL;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int bdma_stm32_get_direction(enum dma_channel_direction direction,
|
|
uint32_t *ll_direction)
|
|
{
|
|
switch (direction) {
|
|
case MEMORY_TO_MEMORY:
|
|
*ll_direction = LL_BDMA_DIRECTION_MEMORY_TO_MEMORY;
|
|
break;
|
|
case MEMORY_TO_PERIPHERAL:
|
|
*ll_direction = LL_BDMA_DIRECTION_MEMORY_TO_PERIPH;
|
|
break;
|
|
case PERIPHERAL_TO_MEMORY:
|
|
*ll_direction = LL_BDMA_DIRECTION_PERIPH_TO_MEMORY;
|
|
break;
|
|
default:
|
|
LOG_ERR("Direction error. %d", direction);
|
|
return -EINVAL;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int bdma_stm32_get_memory_increment(enum dma_addr_adj increment,
|
|
uint32_t *ll_increment)
|
|
{
|
|
switch (increment) {
|
|
case DMA_ADDR_ADJ_INCREMENT:
|
|
*ll_increment = LL_BDMA_MEMORY_INCREMENT;
|
|
break;
|
|
case DMA_ADDR_ADJ_NO_CHANGE:
|
|
*ll_increment = LL_BDMA_MEMORY_NOINCREMENT;
|
|
break;
|
|
case DMA_ADDR_ADJ_DECREMENT:
|
|
return -ENOTSUP;
|
|
default:
|
|
LOG_ERR("Memory increment error. %d", increment);
|
|
return -EINVAL;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int bdma_stm32_get_periph_increment(enum dma_addr_adj increment,
|
|
uint32_t *ll_increment)
|
|
{
|
|
switch (increment) {
|
|
case DMA_ADDR_ADJ_INCREMENT:
|
|
*ll_increment = LL_BDMA_PERIPH_INCREMENT;
|
|
break;
|
|
case DMA_ADDR_ADJ_NO_CHANGE:
|
|
*ll_increment = LL_BDMA_PERIPH_NOINCREMENT;
|
|
break;
|
|
case DMA_ADDR_ADJ_DECREMENT:
|
|
return -ENOTSUP;
|
|
default:
|
|
LOG_ERR("Periph increment error. %d", increment);
|
|
return -EINVAL;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int bdma_stm32_disable_channel(BDMA_TypeDef *bdma, uint32_t id)
|
|
{
|
|
int count = 0;
|
|
|
|
for (;;) {
|
|
if (stm32_bdma_disable_channel(bdma, id) == 0) {
|
|
return 0;
|
|
}
|
|
/* After trying for 5 seconds, give up */
|
|
if (count++ > (5 * 1000)) {
|
|
return -EBUSY;
|
|
}
|
|
k_sleep(K_MSEC(1));
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static bool bdma_stm32_is_valid_memory_address(const uint32_t address, const uint32_t size)
|
|
{
|
|
/* The BDMA can only access memory addresses in SRAM4 */
|
|
|
|
const uint32_t sram4_start = DT_REG_ADDR(DT_NODELABEL(sram4));
|
|
const uint32_t sram4_end = sram4_start + DT_REG_SIZE(DT_NODELABEL(sram4));
|
|
|
|
if (address < sram4_start) {
|
|
return false;
|
|
}
|
|
|
|
if (address + size > sram4_end) {
|
|
return false;
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
|
|
BDMA_STM32_EXPORT_API int bdma_stm32_configure(const struct device *dev,
|
|
uint32_t id,
|
|
struct dma_config *config)
|
|
{
|
|
const struct bdma_stm32_config *dev_config = dev->config;
|
|
struct bdma_stm32_channel *channel =
|
|
&dev_config->channels[id];
|
|
BDMA_TypeDef *bdma = (BDMA_TypeDef *)dev_config->base;
|
|
LL_BDMA_InitTypeDef BDMA_InitStruct;
|
|
int index;
|
|
int ret;
|
|
|
|
LL_BDMA_StructInit(&BDMA_InitStruct);
|
|
|
|
if (id >= dev_config->max_channels) {
|
|
LOG_ERR("cannot configure the bdma channel %d.", id);
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (channel->busy) {
|
|
LOG_ERR("bdma channel %d is busy.", id);
|
|
return -EBUSY;
|
|
}
|
|
|
|
if (bdma_stm32_disable_channel(bdma, id) != 0) {
|
|
LOG_ERR("could not disable bdma channel %d.", id);
|
|
return -EBUSY;
|
|
}
|
|
|
|
bdma_stm32_clear_channel_irq(dev, id);
|
|
|
|
if (config->head_block->block_size > BDMA_STM32_MAX_DATA_ITEMS) {
|
|
LOG_ERR("Data size too big: %d\n",
|
|
config->head_block->block_size);
|
|
return -EINVAL;
|
|
}
|
|
|
|
if ((config->channel_direction == MEMORY_TO_MEMORY) &&
|
|
(!dev_config->support_m2m)) {
|
|
LOG_ERR("Memcopy not supported for device %s",
|
|
dev->name);
|
|
return -ENOTSUP;
|
|
}
|
|
|
|
/* support only the same data width for source and dest */
|
|
if (config->dest_data_size != config->source_data_size) {
|
|
LOG_ERR("source and dest data size differ.");
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (config->source_data_size != 4U &&
|
|
config->source_data_size != 2U &&
|
|
config->source_data_size != 1U) {
|
|
LOG_ERR("source and dest unit size error, %d",
|
|
config->source_data_size);
|
|
return -EINVAL;
|
|
}
|
|
|
|
/*
|
|
* STM32's circular mode will auto reset both source address
|
|
* counter and destination address counter.
|
|
*/
|
|
if (config->head_block->source_reload_en !=
|
|
config->head_block->dest_reload_en) {
|
|
LOG_ERR("source_reload_en and dest_reload_en must "
|
|
"be the same.");
|
|
return -EINVAL;
|
|
}
|
|
|
|
channel->busy = true;
|
|
channel->bdma_callback = config->dma_callback;
|
|
channel->direction = config->channel_direction;
|
|
channel->user_data = config->user_data;
|
|
channel->src_size = config->source_data_size;
|
|
channel->dst_size = config->dest_data_size;
|
|
|
|
/* check dest or source memory address, warn if 0 */
|
|
if (config->head_block->source_address == 0) {
|
|
LOG_WRN("source_buffer address is null.");
|
|
}
|
|
|
|
if (config->head_block->dest_address == 0) {
|
|
LOG_WRN("dest_buffer address is null.");
|
|
}
|
|
|
|
/* ensure all memory addresses are in SRAM4 */
|
|
if (channel->direction == MEMORY_TO_PERIPHERAL || channel->direction == MEMORY_TO_MEMORY) {
|
|
if (!bdma_stm32_is_valid_memory_address(config->head_block->source_address,
|
|
config->head_block->block_size)) {
|
|
LOG_ERR("invalid source address");
|
|
return -EINVAL;
|
|
}
|
|
}
|
|
if (channel->direction == PERIPHERAL_TO_MEMORY || channel->direction == MEMORY_TO_MEMORY) {
|
|
if (!bdma_stm32_is_valid_memory_address(config->head_block->dest_address,
|
|
config->head_block->block_size)) {
|
|
LOG_ERR("invalid destination address");
|
|
return -EINVAL;
|
|
}
|
|
}
|
|
|
|
if (channel->direction == MEMORY_TO_PERIPHERAL) {
|
|
BDMA_InitStruct.MemoryOrM2MDstAddress =
|
|
config->head_block->source_address;
|
|
BDMA_InitStruct.PeriphOrM2MSrcAddress =
|
|
config->head_block->dest_address;
|
|
} else {
|
|
BDMA_InitStruct.PeriphOrM2MSrcAddress =
|
|
config->head_block->source_address;
|
|
BDMA_InitStruct.MemoryOrM2MDstAddress =
|
|
config->head_block->dest_address;
|
|
}
|
|
|
|
uint16_t memory_addr_adj = 0, periph_addr_adj = 0;
|
|
|
|
ret = bdma_stm32_get_priority(config->channel_priority,
|
|
&BDMA_InitStruct.Priority);
|
|
if (ret < 0) {
|
|
return ret;
|
|
}
|
|
|
|
ret = bdma_stm32_get_direction(config->channel_direction,
|
|
&BDMA_InitStruct.Direction);
|
|
if (ret < 0) {
|
|
return ret;
|
|
}
|
|
|
|
switch (config->channel_direction) {
|
|
case MEMORY_TO_MEMORY:
|
|
case PERIPHERAL_TO_MEMORY:
|
|
memory_addr_adj = config->head_block->dest_addr_adj;
|
|
periph_addr_adj = config->head_block->source_addr_adj;
|
|
break;
|
|
case MEMORY_TO_PERIPHERAL:
|
|
memory_addr_adj = config->head_block->source_addr_adj;
|
|
periph_addr_adj = config->head_block->dest_addr_adj;
|
|
break;
|
|
/* Direction has been asserted in bdma_stm32_get_direction. */
|
|
default:
|
|
LOG_ERR("Channel direction error (%d).",
|
|
config->channel_direction);
|
|
return -EINVAL;
|
|
}
|
|
|
|
ret = bdma_stm32_get_memory_increment(memory_addr_adj,
|
|
&BDMA_InitStruct.MemoryOrM2MDstIncMode);
|
|
if (ret < 0) {
|
|
return ret;
|
|
}
|
|
ret = bdma_stm32_get_periph_increment(periph_addr_adj,
|
|
&BDMA_InitStruct.PeriphOrM2MSrcIncMode);
|
|
if (ret < 0) {
|
|
return ret;
|
|
}
|
|
|
|
if (config->head_block->source_reload_en) {
|
|
BDMA_InitStruct.Mode = LL_BDMA_MODE_CIRCULAR;
|
|
} else {
|
|
BDMA_InitStruct.Mode = LL_BDMA_MODE_NORMAL;
|
|
}
|
|
|
|
channel->source_periph = (channel->direction == PERIPHERAL_TO_MEMORY);
|
|
|
|
/* set the data width, when source_data_size equals dest_data_size */
|
|
index = find_lsb_set(config->source_data_size) - 1;
|
|
BDMA_InitStruct.PeriphOrM2MSrcDataSize = table_p_size[index];
|
|
index = find_lsb_set(config->dest_data_size) - 1;
|
|
BDMA_InitStruct.MemoryOrM2MDstDataSize = table_m_size[index];
|
|
|
|
if (channel->source_periph) {
|
|
BDMA_InitStruct.NbData = config->head_block->block_size /
|
|
config->source_data_size;
|
|
} else {
|
|
BDMA_InitStruct.NbData = config->head_block->block_size /
|
|
config->dest_data_size;
|
|
}
|
|
|
|
#if defined(CONFIG_DMAMUX_STM32)
|
|
/*
|
|
* with bdma mux,
|
|
* the request ID is stored in the dma_slot
|
|
*/
|
|
BDMA_InitStruct.PeriphRequest = config->dma_slot;
|
|
#endif
|
|
LL_BDMA_Init(bdma, bdma_stm32_id_to_channel(id), &BDMA_InitStruct);
|
|
|
|
LL_BDMA_EnableIT_TC(bdma, bdma_stm32_id_to_channel(id));
|
|
|
|
/* Enable Half-Transfer irq if circular mode is enabled */
|
|
if (config->head_block->source_reload_en) {
|
|
LL_BDMA_EnableIT_HT(bdma, bdma_stm32_id_to_channel(id));
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
BDMA_STM32_EXPORT_API int bdma_stm32_reload(const struct device *dev, uint32_t id,
|
|
uint32_t src, uint32_t dst,
|
|
size_t size)
|
|
{
|
|
const struct bdma_stm32_config *config = dev->config;
|
|
BDMA_TypeDef *bdma = (BDMA_TypeDef *)(config->base);
|
|
struct bdma_stm32_channel *channel;
|
|
|
|
if (id >= config->max_channels) {
|
|
return -EINVAL;
|
|
}
|
|
|
|
channel = &config->channels[id];
|
|
|
|
if (bdma_stm32_disable_channel(bdma, id) != 0) {
|
|
return -EBUSY;
|
|
}
|
|
|
|
switch (channel->direction) {
|
|
case MEMORY_TO_PERIPHERAL:
|
|
LL_BDMA_SetMemoryAddress(bdma, bdma_stm32_id_to_channel(id), src);
|
|
LL_BDMA_SetPeriphAddress(bdma, bdma_stm32_id_to_channel(id), dst);
|
|
break;
|
|
case MEMORY_TO_MEMORY:
|
|
case PERIPHERAL_TO_MEMORY:
|
|
LL_BDMA_SetPeriphAddress(bdma, bdma_stm32_id_to_channel(id), src);
|
|
LL_BDMA_SetMemoryAddress(bdma, bdma_stm32_id_to_channel(id), dst);
|
|
break;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (channel->source_periph) {
|
|
LL_BDMA_SetDataLength(bdma, bdma_stm32_id_to_channel(id),
|
|
size / channel->src_size);
|
|
} else {
|
|
LL_BDMA_SetDataLength(bdma, bdma_stm32_id_to_channel(id),
|
|
size / channel->dst_size);
|
|
}
|
|
|
|
/* When reloading the dma, the channel is busy again before enabling */
|
|
channel->busy = true;
|
|
|
|
stm32_bdma_enable_channel(bdma, id);
|
|
|
|
return 0;
|
|
}
|
|
|
|
BDMA_STM32_EXPORT_API int bdma_stm32_start(const struct device *dev, uint32_t id)
|
|
{
|
|
const struct bdma_stm32_config *config = dev->config;
|
|
BDMA_TypeDef *bdma = (BDMA_TypeDef *)(config->base);
|
|
struct bdma_stm32_channel *channel;
|
|
|
|
/* Only M2P or M2M mode can be started manually. */
|
|
if (id >= config->max_channels) {
|
|
return -EINVAL;
|
|
}
|
|
|
|
/* Repeated start : return now if channel is already started */
|
|
if (stm32_bdma_is_enabled_channel(bdma, id)) {
|
|
return 0;
|
|
}
|
|
|
|
/* When starting the dma, the channel is busy before enabling */
|
|
channel = &config->channels[id];
|
|
channel->busy = true;
|
|
|
|
bdma_stm32_clear_channel_irq(dev, id);
|
|
stm32_bdma_enable_channel(bdma, id);
|
|
|
|
return 0;
|
|
}
|
|
|
|
BDMA_STM32_EXPORT_API int bdma_stm32_stop(const struct device *dev, uint32_t id)
|
|
{
|
|
const struct bdma_stm32_config *config = dev->config;
|
|
struct bdma_stm32_channel *channel = &config->channels[id];
|
|
BDMA_TypeDef *bdma = (BDMA_TypeDef *)(config->base);
|
|
|
|
if (id >= config->max_channels) {
|
|
return -EINVAL;
|
|
}
|
|
|
|
/* Repeated stop : return now if channel is already stopped */
|
|
if (!stm32_bdma_is_enabled_channel(bdma, id)) {
|
|
return 0;
|
|
}
|
|
|
|
/* in bdma_stm32_configure, enabling is done regardless of defines */
|
|
LL_BDMA_DisableIT_TC(bdma, bdma_stm32_id_to_channel(id));
|
|
LL_BDMA_DisableIT_HT(bdma, bdma_stm32_id_to_channel(id));
|
|
|
|
bdma_stm32_disable_channel(bdma, id);
|
|
bdma_stm32_clear_channel_irq(dev, id);
|
|
|
|
/* Finally, flag channel as free */
|
|
channel->busy = false;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int bdma_stm32_init(const struct device *dev)
|
|
{
|
|
const struct bdma_stm32_config *config = dev->config;
|
|
const struct device *const clk = DEVICE_DT_GET(STM32_CLOCK_CONTROL_NODE);
|
|
|
|
if (!device_is_ready(clk)) {
|
|
LOG_ERR("clock control device not ready");
|
|
return -ENODEV;
|
|
}
|
|
|
|
if (clock_control_on(clk,
|
|
(clock_control_subsys_t) &config->pclken) != 0) {
|
|
LOG_ERR("clock op failed\n");
|
|
return -EIO;
|
|
}
|
|
|
|
config->config_irq(dev);
|
|
|
|
for (uint32_t i = 0; i < config->max_channels; i++) {
|
|
config->channels[i].busy = false;
|
|
#ifdef CONFIG_DMAMUX_STM32
|
|
/* each further channel->mux_channel is fixed here */
|
|
config->channels[i].mux_channel = i + config->offset;
|
|
#endif /* CONFIG_DMAMUX_STM32 */
|
|
}
|
|
|
|
((struct bdma_stm32_data *)dev->data)->dma_ctx.magic = 0;
|
|
((struct bdma_stm32_data *)dev->data)->dma_ctx.dma_channels = 0;
|
|
((struct bdma_stm32_data *)dev->data)->dma_ctx.atomic = 0;
|
|
|
|
/* The BDMA can only access SRAM4 and assumes it's nocachable
|
|
* This check verifies that the non-cachable flag is set in the DTS.
|
|
* For example:
|
|
* &sram4 {
|
|
* zephyr,memory-attr = "RAM_NOCACHE";
|
|
* };
|
|
*/
|
|
#if DT_NODE_HAS_PROP(DT_NODELABEL(sram4), zephyr_memory_attr)
|
|
if ((DT_PROP(DT_NODELABEL(sram4), zephyr_memory_attr) & DT_MEM_ARM_MPU_RAM_NOCACHE) == 0) {
|
|
LOG_ERR("SRAM4 is not set as non-cachable.");
|
|
return -EIO;
|
|
}
|
|
#else
|
|
#error "BDMA driver expects SRAM4 to be set as RAM_NOCACHE in DTS"
|
|
#endif
|
|
|
|
return 0;
|
|
}
|
|
|
|
BDMA_STM32_EXPORT_API int bdma_stm32_get_status(const struct device *dev,
|
|
uint32_t id, struct dma_status *stat)
|
|
{
|
|
const struct bdma_stm32_config *config = dev->config;
|
|
BDMA_TypeDef *bdma = (BDMA_TypeDef *)(config->base);
|
|
struct bdma_stm32_channel *channel;
|
|
|
|
if (id >= config->max_channels) {
|
|
return -EINVAL;
|
|
}
|
|
|
|
channel = &config->channels[id];
|
|
stat->pending_length = LL_BDMA_GetDataLength(bdma, bdma_stm32_id_to_channel(id));
|
|
stat->dir = channel->direction;
|
|
stat->busy = channel->busy;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct dma_driver_api dma_funcs = {
|
|
.reload = bdma_stm32_reload,
|
|
.config = bdma_stm32_configure,
|
|
.start = bdma_stm32_start,
|
|
.stop = bdma_stm32_stop,
|
|
.get_status = bdma_stm32_get_status,
|
|
};
|
|
|
|
#ifdef CONFIG_DMAMUX_STM32
|
|
#define BDMA_STM32_OFFSET_INIT(index) \
|
|
.offset = DT_INST_PROP(index, dma_offset),
|
|
#else
|
|
#define BDMA_STM32_OFFSET_INIT(index)
|
|
#endif /* CONFIG_DMAMUX_STM32 */
|
|
|
|
#define BDMA_STM32_INIT_DEV(index) \
|
|
static struct bdma_stm32_channel \
|
|
bdma_stm32_channels_##index[BDMA_STM32_##index##_CHANNEL_COUNT];\
|
|
\
|
|
const struct bdma_stm32_config bdma_stm32_config_##index = { \
|
|
.pclken = { .bus = DT_INST_CLOCKS_CELL(index, bus), \
|
|
.enr = DT_INST_CLOCKS_CELL(index, bits) }, \
|
|
.config_irq = bdma_stm32_config_irq_##index, \
|
|
.base = DT_INST_REG_ADDR(index), \
|
|
.support_m2m = DT_INST_PROP(index, st_mem2mem), \
|
|
.max_channels = BDMA_STM32_##index##_CHANNEL_COUNT, \
|
|
.channels = bdma_stm32_channels_##index, \
|
|
BDMA_STM32_OFFSET_INIT(index) \
|
|
}; \
|
|
\
|
|
static struct bdma_stm32_data bdma_stm32_data_##index = { \
|
|
}; \
|
|
\
|
|
DEVICE_DT_INST_DEFINE(index, \
|
|
&bdma_stm32_init, \
|
|
NULL, \
|
|
&bdma_stm32_data_##index, &bdma_stm32_config_##index, \
|
|
PRE_KERNEL_1, CONFIG_KERNEL_INIT_PRIORITY_DEFAULT, \
|
|
&dma_funcs)
|
|
|
|
#define BDMA_STM32_DEFINE_IRQ_HANDLER(bdma, chan) \
|
|
static void bdma_stm32_irq_##bdma##_##chan(const struct device *dev) \
|
|
{ \
|
|
bdma_stm32_irq_handler(dev, chan); \
|
|
}
|
|
|
|
|
|
#define BDMA_STM32_IRQ_CONNECT(bdma, chan) \
|
|
do { \
|
|
IRQ_CONNECT(DT_INST_IRQ_BY_IDX(bdma, chan, irq), \
|
|
DT_INST_IRQ_BY_IDX(bdma, chan, priority), \
|
|
bdma_stm32_irq_##bdma##_##chan, \
|
|
DEVICE_DT_INST_GET(bdma), 0); \
|
|
irq_enable(DT_INST_IRQ_BY_IDX(bdma, chan, irq)); \
|
|
} while (false)
|
|
|
|
|
|
#if DT_NODE_HAS_STATUS(DT_DRV_INST(0), okay)
|
|
|
|
#define BDMA_STM32_DEFINE_IRQ_HANDLER_GEN(i, _) \
|
|
BDMA_STM32_DEFINE_IRQ_HANDLER(0, i)
|
|
LISTIFY(DT_NUM_IRQS(DT_DRV_INST(0)), BDMA_STM32_DEFINE_IRQ_HANDLER_GEN, (;));
|
|
|
|
static void bdma_stm32_config_irq_0(const struct device *dev)
|
|
{
|
|
ARG_UNUSED(dev);
|
|
|
|
#define BDMA_STM32_IRQ_CONNECT_GEN(i, _) \
|
|
BDMA_STM32_IRQ_CONNECT(0, i);
|
|
LISTIFY(DT_NUM_IRQS(DT_DRV_INST(0)), BDMA_STM32_IRQ_CONNECT_GEN, (;));
|
|
}
|
|
|
|
BDMA_STM32_INIT_DEV(0);
|
|
|
|
#endif /* DT_NODE_HAS_STATUS(DT_DRV_INST(0), okay) */
|