| /* |
| * Copyright (c) 2016 Linaro Limited. |
| * Copyright (c) 2019 Song Qiang <songqiang1304521@gmail.com> |
| * Copyright (c) 2022 STMicroelectronics |
| * |
| * SPDX-License-Identifier: Apache-2.0 |
| */ |
| |
| /** |
| * @brief Common part of DMA drivers for stm32U5. |
| * @note Functions named with stm32_dma_* are SoCs related functions |
| * |
| */ |
| |
| #include "dma_stm32.h" |
| |
| #include <zephyr/init.h> |
| #include <zephyr/drivers/clock_control.h> |
| #include <zephyr/drivers/dma/dma_stm32.h> |
| |
| #include <zephyr/logging/log.h> |
| #include <zephyr/irq.h> |
| LOG_MODULE_REGISTER(dma_stm32, CONFIG_DMA_LOG_LEVEL); |
| |
| #define DT_DRV_COMPAT st_stm32u5_dma |
| |
| static const uint32_t table_m_size[] = { |
| LL_DMA_SRC_DATAWIDTH_BYTE, |
| LL_DMA_SRC_DATAWIDTH_HALFWORD, |
| LL_DMA_SRC_DATAWIDTH_WORD, |
| }; |
| |
| static const uint32_t table_p_size[] = { |
| LL_DMA_DEST_DATAWIDTH_BYTE, |
| LL_DMA_DEST_DATAWIDTH_HALFWORD, |
| LL_DMA_DEST_DATAWIDTH_WORD, |
| }; |
| |
| static const uint32_t table_priority[4] = { |
| LL_DMA_LOW_PRIORITY_LOW_WEIGHT, |
| LL_DMA_LOW_PRIORITY_MID_WEIGHT, |
| LL_DMA_LOW_PRIORITY_HIGH_WEIGHT, |
| LL_DMA_HIGH_PRIORITY, |
| }; |
| |
| static void dma_stm32_dump_stream_irq(const struct device *dev, uint32_t id) |
| { |
| const struct dma_stm32_config *config = dev->config; |
| DMA_TypeDef *dma = (DMA_TypeDef *)(config->base); |
| |
| stm32_dma_dump_stream_irq(dma, id); |
| } |
| |
| static void dma_stm32_clear_stream_irq(const struct device *dev, uint32_t id) |
| { |
| const struct dma_stm32_config *config = dev->config; |
| DMA_TypeDef *dma = (DMA_TypeDef *)(config->base); |
| |
| dma_stm32_clear_tc(dma, id); |
| dma_stm32_clear_ht(dma, id); |
| stm32_dma_clear_stream_irq(dma, id); |
| } |
| |
| |
| uint32_t dma_stm32_id_to_stream(uint32_t id) |
| { |
| static const uint32_t stream_nr[] = { |
| LL_DMA_CHANNEL_0, |
| LL_DMA_CHANNEL_1, |
| LL_DMA_CHANNEL_2, |
| LL_DMA_CHANNEL_3, |
| LL_DMA_CHANNEL_4, |
| LL_DMA_CHANNEL_5, |
| LL_DMA_CHANNEL_6, |
| LL_DMA_CHANNEL_7, |
| LL_DMA_CHANNEL_8, |
| LL_DMA_CHANNEL_9, |
| LL_DMA_CHANNEL_10, |
| LL_DMA_CHANNEL_11, |
| LL_DMA_CHANNEL_12, |
| LL_DMA_CHANNEL_13, |
| LL_DMA_CHANNEL_14, |
| LL_DMA_CHANNEL_15, |
| }; |
| |
| __ASSERT_NO_MSG(id < ARRAY_SIZE(stream_nr)); |
| |
| return stream_nr[id]; |
| } |
| |
| bool dma_stm32_is_tc_active(DMA_TypeDef *DMAx, uint32_t id) |
| { |
| return LL_DMA_IsActiveFlag_TC(DMAx, dma_stm32_id_to_stream(id)); |
| } |
| |
| void dma_stm32_clear_tc(DMA_TypeDef *DMAx, uint32_t id) |
| { |
| LL_DMA_ClearFlag_TC(DMAx, dma_stm32_id_to_stream(id)); |
| } |
| |
| /* transfer error either a data or user or link error */ |
| bool dma_stm32_is_te_active(DMA_TypeDef *DMAx, uint32_t id) |
| { |
| return ( |
| LL_DMA_IsActiveFlag_DTE(DMAx, dma_stm32_id_to_stream(id)) || |
| LL_DMA_IsActiveFlag_ULE(DMAx, dma_stm32_id_to_stream(id)) || |
| LL_DMA_IsActiveFlag_USE(DMAx, dma_stm32_id_to_stream(id)) |
| ); |
| } |
| /* clear transfer error either a data or user or link error */ |
| void dma_stm32_clear_te(DMA_TypeDef *DMAx, uint32_t id) |
| { |
| LL_DMA_ClearFlag_DTE(DMAx, dma_stm32_id_to_stream(id)); |
| LL_DMA_ClearFlag_ULE(DMAx, dma_stm32_id_to_stream(id)); |
| LL_DMA_ClearFlag_USE(DMAx, dma_stm32_id_to_stream(id)); |
| } |
| |
| bool dma_stm32_is_ht_active(DMA_TypeDef *DMAx, uint32_t id) |
| { |
| return LL_DMA_IsActiveFlag_HT(DMAx, dma_stm32_id_to_stream(id)); |
| } |
| |
| void dma_stm32_clear_ht(DMA_TypeDef *DMAx, uint32_t id) |
| { |
| LL_DMA_ClearFlag_HT(DMAx, dma_stm32_id_to_stream(id)); |
| } |
| |
| void stm32_dma_dump_stream_irq(DMA_TypeDef *dma, uint32_t id) |
| { |
| LOG_INF("tc: %d, ht: %d, te: %d", |
| dma_stm32_is_tc_active(dma, id), |
| dma_stm32_is_ht_active(dma, id), |
| dma_stm32_is_te_active(dma, id)); |
| } |
| |
| /* Check if nsecure masked interrupt is active on channel */ |
| bool stm32_dma_is_tc_irq_active(DMA_TypeDef *dma, uint32_t id) |
| { |
| return (LL_DMA_IsEnabledIT_TC(dma, dma_stm32_id_to_stream(id)) && |
| LL_DMA_IsActiveFlag_TC(dma, dma_stm32_id_to_stream(id))); |
| } |
| |
| bool stm32_dma_is_ht_irq_active(DMA_TypeDef *dma, uint32_t id) |
| { |
| return (LL_DMA_IsEnabledIT_HT(dma, dma_stm32_id_to_stream(id)) && |
| LL_DMA_IsActiveFlag_HT(dma, dma_stm32_id_to_stream(id))); |
| } |
| |
| static inline bool stm32_dma_is_te_irq_active(DMA_TypeDef *dma, uint32_t id) |
| { |
| return ( |
| (LL_DMA_IsEnabledIT_DTE(dma, dma_stm32_id_to_stream(id)) && |
| LL_DMA_IsActiveFlag_DTE(dma, dma_stm32_id_to_stream(id))) || |
| (LL_DMA_IsEnabledIT_ULE(dma, dma_stm32_id_to_stream(id)) && |
| LL_DMA_IsActiveFlag_ULE(dma, dma_stm32_id_to_stream(id))) || |
| (LL_DMA_IsEnabledIT_USE(dma, dma_stm32_id_to_stream(id)) && |
| LL_DMA_IsActiveFlag_USE(dma, dma_stm32_id_to_stream(id))) |
| ); |
| } |
| |
| /* check if and irq of any type occurred on the channel */ |
| #define stm32_dma_is_irq_active LL_DMA_IsActiveFlag_MIS |
| |
| void stm32_dma_clear_stream_irq(DMA_TypeDef *dma, uint32_t id) |
| { |
| dma_stm32_clear_te(dma, id); |
| |
| LL_DMA_ClearFlag_TO(dma, dma_stm32_id_to_stream(id)); |
| LL_DMA_ClearFlag_SUSP(dma, dma_stm32_id_to_stream(id)); |
| } |
| |
| bool stm32_dma_is_irq_happened(DMA_TypeDef *dma, uint32_t id) |
| { |
| if (dma_stm32_is_te_active(dma, id)) { |
| return true; |
| } |
| |
| return false; |
| } |
| |
| void stm32_dma_enable_stream(DMA_TypeDef *dma, uint32_t id) |
| { |
| LL_DMA_EnableChannel(dma, dma_stm32_id_to_stream(id)); |
| } |
| |
| bool stm32_dma_is_enabled_stream(DMA_TypeDef *dma, uint32_t id) |
| { |
| if (LL_DMA_IsEnabledChannel(dma, dma_stm32_id_to_stream(id)) == 1) { |
| return true; |
| } |
| return false; |
| } |
| |
| int stm32_dma_disable_stream(DMA_TypeDef *dma, uint32_t id) |
| { |
| /* GPDMA channel abort sequence */ |
| LL_DMA_SuspendChannel(dma, dma_stm32_id_to_stream(id)); |
| |
| /* reset the channel will disable it */ |
| LL_DMA_ResetChannel(dma, dma_stm32_id_to_stream(id)); |
| |
| if (!stm32_dma_is_enabled_stream(dma, id)) { |
| return 0; |
| } |
| |
| return -EAGAIN; |
| } |
| |
| void stm32_dma_set_mem_periph_address(DMA_TypeDef *dma, |
| uint32_t channel, |
| uint32_t src_addr, |
| uint32_t dest_addr) |
| { |
| LL_DMA_ConfigAddresses(dma, channel, src_addr, dest_addr); |
| } |
| |
| /* same function to set periph/mem addresses */ |
| void stm32_dma_set_periph_mem_address(DMA_TypeDef *dma, |
| uint32_t channel, |
| uint32_t src_addr, |
| uint32_t dest_addr) |
| { |
| LL_DMA_ConfigAddresses(dma, channel, src_addr, dest_addr); |
| } |
| |
| static void dma_stm32_irq_handler(const struct device *dev, uint32_t id) |
| { |
| const struct dma_stm32_config *config = dev->config; |
| DMA_TypeDef *dma = (DMA_TypeDef *)(config->base); |
| struct dma_stm32_stream *stream; |
| uint32_t callback_arg; |
| |
| __ASSERT_NO_MSG(id < config->max_streams); |
| |
| stream = &config->streams[id]; |
| /* The busy channel is pertinent if not overridden by the HAL */ |
| if ((stream->hal_override != true) && (stream->busy == false)) { |
| /* |
| * When DMA channel is not overridden by HAL, |
| * ignore irq if the channel is not busy anymore |
| */ |
| dma_stm32_clear_stream_irq(dev, id); |
| return; |
| } |
| callback_arg = id + STM32_DMA_STREAM_OFFSET; |
| stream->busy = false; |
| |
| /* The dma stream id is in range from STM32_DMA_STREAM_OFFSET..<dma-requests> */ |
| if (stm32_dma_is_ht_irq_active(dma, id)) { |
| /* Let HAL DMA handle flags on its own */ |
| if (!stream->hal_override) { |
| dma_stm32_clear_ht(dma, id); |
| } |
| stream->dma_callback(dev, stream->user_data, callback_arg, DMA_STATUS_BLOCK); |
| } else if (stm32_dma_is_tc_irq_active(dma, id)) { |
| /* Let HAL DMA handle flags on its own */ |
| if (!stream->hal_override) { |
| dma_stm32_clear_tc(dma, id); |
| } |
| stream->dma_callback(dev, stream->user_data, callback_arg, DMA_STATUS_COMPLETE); |
| } else { |
| LOG_ERR("Transfer Error."); |
| dma_stm32_dump_stream_irq(dev, id); |
| dma_stm32_clear_stream_irq(dev, id); |
| stream->dma_callback(dev, stream->user_data, |
| callback_arg, -EIO); |
| } |
| } |
| |
| static int dma_stm32_get_priority(uint8_t priority, uint32_t *ll_priority) |
| { |
| if (priority > ARRAY_SIZE(table_priority)) { |
| LOG_ERR("Priority error. %d", priority); |
| return -EINVAL; |
| } |
| |
| *ll_priority = table_priority[priority]; |
| return 0; |
| } |
| |
| static int dma_stm32_get_direction(enum dma_channel_direction direction, |
| uint32_t *ll_direction) |
| { |
| switch (direction) { |
| case MEMORY_TO_MEMORY: |
| *ll_direction = LL_DMA_DIRECTION_MEMORY_TO_MEMORY; |
| break; |
| case MEMORY_TO_PERIPHERAL: |
| *ll_direction = LL_DMA_DIRECTION_MEMORY_TO_PERIPH; |
| break; |
| case PERIPHERAL_TO_MEMORY: |
| *ll_direction = LL_DMA_DIRECTION_PERIPH_TO_MEMORY; |
| break; |
| default: |
| LOG_ERR("Direction error. %d", direction); |
| return -EINVAL; |
| } |
| |
| return 0; |
| } |
| |
| static int dma_stm32_disable_stream(DMA_TypeDef *dma, uint32_t id) |
| { |
| int count = 0; |
| |
| for (;;) { |
| if (stm32_dma_disable_stream(dma, 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 int dma_stm32_configure(const struct device *dev, |
| uint32_t id, |
| struct dma_config *config) |
| { |
| const struct dma_stm32_config *dev_config = dev->config; |
| struct dma_stm32_stream *stream = |
| &dev_config->streams[id - STM32_DMA_STREAM_OFFSET]; |
| DMA_TypeDef *dma = (DMA_TypeDef *)dev_config->base; |
| LL_DMA_InitTypeDef DMA_InitStruct; |
| int ret; |
| |
| LL_DMA_StructInit(&DMA_InitStruct); |
| |
| /* Give channel from index 0 */ |
| id = id - STM32_DMA_STREAM_OFFSET; |
| |
| if (id >= dev_config->max_streams) { |
| LOG_ERR("cannot configure the dma stream %d.", id); |
| return -EINVAL; |
| } |
| |
| if (stream->busy) { |
| LOG_ERR("dma stream %d is busy.", id); |
| return -EBUSY; |
| } |
| |
| if (dma_stm32_disable_stream(dma, id) != 0) { |
| LOG_ERR("could not disable dma stream %d.", id); |
| return -EBUSY; |
| } |
| |
| dma_stm32_clear_stream_irq(dev, id); |
| |
| /* Check potential DMA override (if id parameters and stream are valid) */ |
| if (config->linked_channel == STM32_DMA_HAL_OVERRIDE) { |
| /* DMA channel is overridden by HAL DMA |
| * Retain that the channel is busy and proceed to the minimal |
| * configuration to properly route the IRQ |
| */ |
| stream->busy = true; |
| stream->hal_override = true; |
| stream->dma_callback = config->dma_callback; |
| stream->user_data = config->user_data; |
| return 0; |
| } |
| |
| if (config->head_block->block_size > DMA_STM32_MAX_DATA_ITEMS) { |
| LOG_ERR("Data size too big: %d\n", |
| config->head_block->block_size); |
| return -EINVAL; |
| } |
| |
| /* 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; |
| } |
| |
| stream->busy = true; |
| stream->dma_callback = config->dma_callback; |
| stream->direction = config->channel_direction; |
| stream->user_data = config->user_data; |
| stream->src_size = config->source_data_size; |
| stream->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."); |
| } |
| |
| DMA_InitStruct.SrcAddress = config->head_block->source_address; |
| DMA_InitStruct.DestAddress = config->head_block->dest_address; |
| DMA_InitStruct.BlkHWRequest = LL_DMA_HWREQUEST_SINGLEBURST; |
| DMA_InitStruct.DataAlignment = LL_DMA_DATA_ALIGN_ZEROPADD; |
| |
| ret = dma_stm32_get_priority(config->channel_priority, |
| &DMA_InitStruct.Priority); |
| if (ret < 0) { |
| return ret; |
| } |
| |
| ret = dma_stm32_get_direction(config->channel_direction, |
| &DMA_InitStruct.Direction); |
| if (ret < 0) { |
| return ret; |
| } |
| |
| /* This part is for source */ |
| switch (config->head_block->source_addr_adj) { |
| case DMA_ADDR_ADJ_INCREMENT: |
| DMA_InitStruct.SrcIncMode = LL_DMA_SRC_INCREMENT; |
| break; |
| case DMA_ADDR_ADJ_NO_CHANGE: |
| DMA_InitStruct.SrcIncMode = LL_DMA_SRC_FIXED; |
| break; |
| case DMA_ADDR_ADJ_DECREMENT: |
| return -ENOTSUP; |
| default: |
| LOG_ERR("Memory increment error. %d", |
| config->head_block->source_addr_adj); |
| return -EINVAL; |
| } |
| LOG_DBG("Channel (%d) src inc (%x).", |
| id, DMA_InitStruct.SrcIncMode); |
| |
| /* This part is for dest */ |
| switch (config->head_block->dest_addr_adj) { |
| case DMA_ADDR_ADJ_INCREMENT: |
| DMA_InitStruct.DestIncMode = LL_DMA_DEST_INCREMENT; |
| break; |
| case DMA_ADDR_ADJ_NO_CHANGE: |
| DMA_InitStruct.DestIncMode = LL_DMA_DEST_FIXED; |
| break; |
| case DMA_ADDR_ADJ_DECREMENT: |
| return -ENOTSUP; |
| default: |
| LOG_ERR("Periph increment error. %d", |
| config->head_block->dest_addr_adj); |
| return -EINVAL; |
| } |
| LOG_DBG("Channel (%d) dest inc (%x).", |
| id, DMA_InitStruct.DestIncMode); |
| |
| stream->source_periph = (stream->direction == PERIPHERAL_TO_MEMORY); |
| |
| /* Set the data width, when source_data_size equals dest_data_size */ |
| int index = find_lsb_set(config->source_data_size) - 1; |
| |
| DMA_InitStruct.SrcDataWidth = table_p_size[index]; |
| |
| index = find_lsb_set(config->dest_data_size) - 1; |
| DMA_InitStruct.DestDataWidth = table_m_size[index]; |
| |
| if (stream->source_periph) { |
| DMA_InitStruct.BlkDataLength = config->head_block->block_size / |
| config->source_data_size; |
| } else { |
| DMA_InitStruct.BlkDataLength = config->head_block->block_size / |
| config->dest_data_size; |
| } |
| |
| /* The request ID is stored in the dma_slot */ |
| DMA_InitStruct.Request = config->dma_slot; |
| |
| LL_DMA_Init(dma, dma_stm32_id_to_stream(id), &DMA_InitStruct); |
| |
| LL_DMA_EnableIT_TC(dma, dma_stm32_id_to_stream(id)); |
| |
| /* Enable Half-Transfer irq if circular mode is enabled */ |
| if (config->head_block->source_reload_en) { |
| LL_DMA_EnableIT_HT(dma, dma_stm32_id_to_stream(id)); |
| } |
| |
| return ret; |
| } |
| |
| static int dma_stm32_reload(const struct device *dev, uint32_t id, |
| uint32_t src, uint32_t dst, |
| size_t size) |
| { |
| const struct dma_stm32_config *config = dev->config; |
| DMA_TypeDef *dma = (DMA_TypeDef *)(config->base); |
| struct dma_stm32_stream *stream; |
| |
| /* Give channel from index 0 */ |
| id = id - STM32_DMA_STREAM_OFFSET; |
| |
| if (id >= config->max_streams) { |
| return -EINVAL; |
| } |
| |
| stream = &config->streams[id]; |
| |
| if (dma_stm32_disable_stream(dma, id) != 0) { |
| return -EBUSY; |
| } |
| |
| if (stream->direction > PERIPHERAL_TO_MEMORY) { |
| return -EINVAL; |
| } |
| |
| LL_DMA_ConfigAddresses(dma, |
| dma_stm32_id_to_stream(id), |
| src, dst); |
| |
| if (stream->source_periph) { |
| LL_DMA_SetBlkDataLength(dma, dma_stm32_id_to_stream(id), |
| size / stream->src_size); |
| } else { |
| LL_DMA_SetBlkDataLength(dma, dma_stm32_id_to_stream(id), |
| size / stream->dst_size); |
| } |
| |
| /* When reloading the dma, the stream is busy again before enabling */ |
| stream->busy = true; |
| |
| stm32_dma_enable_stream(dma, id); |
| |
| return 0; |
| } |
| |
| static int dma_stm32_start(const struct device *dev, uint32_t id) |
| { |
| const struct dma_stm32_config *config = dev->config; |
| DMA_TypeDef *dma = (DMA_TypeDef *)(config->base); |
| struct dma_stm32_stream *stream; |
| |
| /* Give channel from index 0 */ |
| id = id - STM32_DMA_STREAM_OFFSET; |
| |
| /* Only M2P or M2M mode can be started manually. */ |
| if (id >= config->max_streams) { |
| return -EINVAL; |
| } |
| |
| /* Repeated start : return now if channel is already started */ |
| if (stm32_dma_is_enabled_stream(dma, id)) { |
| return 0; |
| } |
| |
| /* When starting the dma, the stream is busy before enabling */ |
| stream = &config->streams[id]; |
| stream->busy = true; |
| |
| dma_stm32_clear_stream_irq(dev, id); |
| |
| stm32_dma_enable_stream(dma, id); |
| |
| return 0; |
| } |
| |
| static int dma_stm32_suspend(const struct device *dev, uint32_t id) |
| { |
| const struct dma_stm32_config *config = dev->config; |
| DMA_TypeDef *dma = (DMA_TypeDef *)(config->base); |
| |
| /* Give channel from index 0 */ |
| id = id - STM32_DMA_STREAM_OFFSET; |
| |
| if (id >= config->max_streams) { |
| return -EINVAL; |
| } |
| |
| /* Suspend the channel and wait for suspend Flag set */ |
| LL_DMA_SuspendChannel(dma, dma_stm32_id_to_stream(id)); |
| /* It's not enough to wait for the SUSPF bit with LL_DMA_IsActiveFlag_SUSP */ |
| do { |
| k_msleep(1); /* A delay is needed (1ms is valid) */ |
| } while (LL_DMA_IsActiveFlag_SUSP(dma, dma_stm32_id_to_stream(id)) != 1); |
| |
| /* Do not Reset the channel to allow resuming later */ |
| return 0; |
| } |
| |
| static int dma_stm32_resume(const struct device *dev, uint32_t id) |
| { |
| const struct dma_stm32_config *config = dev->config; |
| DMA_TypeDef *dma = (DMA_TypeDef *)(config->base); |
| |
| /* Give channel from index 0 */ |
| id = id - STM32_DMA_STREAM_OFFSET; |
| |
| if (id >= config->max_streams) { |
| return -EINVAL; |
| } |
| |
| /* Resume the channel : it's enough after suspend */ |
| LL_DMA_ResumeChannel(dma, dma_stm32_id_to_stream(id)); |
| |
| return 0; |
| } |
| |
| static int dma_stm32_stop(const struct device *dev, uint32_t id) |
| { |
| const struct dma_stm32_config *config = dev->config; |
| struct dma_stm32_stream *stream = &config->streams[id - STM32_DMA_STREAM_OFFSET]; |
| DMA_TypeDef *dma = (DMA_TypeDef *)(config->base); |
| |
| /* Give channel from index 0 */ |
| id = id - STM32_DMA_STREAM_OFFSET; |
| |
| if (id >= config->max_streams) { |
| return -EINVAL; |
| } |
| |
| /* Repeated stop : return now if channel is already stopped */ |
| if (!stm32_dma_is_enabled_stream(dma, id)) { |
| return 0; |
| } |
| |
| LL_DMA_DisableIT_TC(dma, dma_stm32_id_to_stream(id)); |
| |
| dma_stm32_clear_stream_irq(dev, id); |
| dma_stm32_disable_stream(dma, id); |
| |
| /* Finally, flag stream as free */ |
| stream->busy = false; |
| |
| return 0; |
| } |
| |
| static int dma_stm32_init(const struct device *dev) |
| { |
| const struct dma_stm32_config *config = dev->config; |
| const struct device *clk = DEVICE_DT_GET(STM32_CLOCK_CONTROL_NODE); |
| |
| 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_streams; i++) { |
| config->streams[i].busy = false; |
| } |
| |
| ((struct dma_stm32_data *)dev->data)->dma_ctx.magic = 0; |
| ((struct dma_stm32_data *)dev->data)->dma_ctx.dma_channels = 0; |
| ((struct dma_stm32_data *)dev->data)->dma_ctx.atomic = 0; |
| |
| return 0; |
| } |
| |
| static int dma_stm32_get_status(const struct device *dev, |
| uint32_t id, struct dma_status *stat) |
| { |
| const struct dma_stm32_config *config = dev->config; |
| DMA_TypeDef *dma = (DMA_TypeDef *)(config->base); |
| struct dma_stm32_stream *stream; |
| |
| /* Give channel from index 0 */ |
| id = id - STM32_DMA_STREAM_OFFSET; |
| if (id >= config->max_streams) { |
| return -EINVAL; |
| } |
| |
| stream = &config->streams[id]; |
| stat->pending_length = LL_DMA_GetBlkDataLength(dma, dma_stm32_id_to_stream(id)); |
| stat->dir = stream->direction; |
| stat->busy = stream->busy; |
| |
| return 0; |
| } |
| |
| static const struct dma_driver_api dma_funcs = { |
| .reload = dma_stm32_reload, |
| .config = dma_stm32_configure, |
| .start = dma_stm32_start, |
| .stop = dma_stm32_stop, |
| .get_status = dma_stm32_get_status, |
| .suspend = dma_stm32_suspend, |
| .resume = dma_stm32_resume, |
| }; |
| |
| /* |
| * Macro to CONNECT and enable each irq (order is given by the 'listify') |
| * chan: channel of the DMA instance (assuming one irq per channel) |
| * stm32U5x has 16 channels |
| * dma : dma instance (one GPDMA instance on stm32U5x) |
| */ |
| #define DMA_STM32_IRQ_CONNECT_CHANNEL(chan, dma) \ |
| do { \ |
| IRQ_CONNECT(DT_INST_IRQ_BY_IDX(dma, chan, irq), \ |
| DT_INST_IRQ_BY_IDX(dma, chan, priority), \ |
| dma_stm32_irq_##dma##_##chan, \ |
| DEVICE_DT_INST_GET(dma), 0); \ |
| irq_enable(DT_INST_IRQ_BY_IDX(dma, chan, irq)); \ |
| } while (0) |
| |
| /* |
| * Macro to configure the irq for each dma instance (index) |
| * Loop to CONNECT and enable each irq for each channel |
| * Expecting as many irq as property <dma_channels> |
| */ |
| #define DMA_STM32_IRQ_CONNECT(index) \ |
| static void dma_stm32_config_irq_##index(const struct device *dev) \ |
| { \ |
| ARG_UNUSED(dev); \ |
| \ |
| LISTIFY(DT_INST_PROP(index, dma_channels), \ |
| DMA_STM32_IRQ_CONNECT_CHANNEL, (;), index); \ |
| } |
| |
| /* |
| * Macro to instanciate the irq handler (order is given by the 'listify') |
| * chan: channel of the DMA instance (assuming one irq per channel) |
| * stm32U5x has 16 channels |
| * dma : dma instance (one GPDMA instance on stm32U5x) |
| */ |
| #define DMA_STM32_DEFINE_IRQ_HANDLER(chan, dma) \ |
| static void dma_stm32_irq_##dma##_##chan(const struct device *dev) \ |
| { \ |
| dma_stm32_irq_handler(dev, chan); \ |
| } |
| |
| #define DMA_STM32_INIT_DEV(index) \ |
| BUILD_ASSERT(DT_INST_PROP(index, dma_channels) \ |
| == DT_NUM_IRQS(DT_DRV_INST(index)), \ |
| "Nb of Channels and IRQ mismatch"); \ |
| \ |
| LISTIFY(DT_INST_PROP(index, dma_channels), \ |
| DMA_STM32_DEFINE_IRQ_HANDLER, (;), index); \ |
| \ |
| DMA_STM32_IRQ_CONNECT(index); \ |
| \ |
| static struct dma_stm32_stream \ |
| dma_stm32_streams_##index[DT_INST_PROP_OR(index, dma_channels, \ |
| DT_NUM_IRQS(DT_DRV_INST(index)))]; \ |
| \ |
| const struct dma_stm32_config dma_stm32_config_##index = { \ |
| .pclken = { .bus = DT_INST_CLOCKS_CELL(index, bus), \ |
| .enr = DT_INST_CLOCKS_CELL(index, bits) }, \ |
| .config_irq = dma_stm32_config_irq_##index, \ |
| .base = DT_INST_REG_ADDR(index), \ |
| .max_streams = DT_INST_PROP_OR(index, dma_channels, \ |
| DT_NUM_IRQS(DT_DRV_INST(index)) \ |
| ), \ |
| .streams = dma_stm32_streams_##index, \ |
| }; \ |
| \ |
| static struct dma_stm32_data dma_stm32_data_##index = { \ |
| }; \ |
| \ |
| DEVICE_DT_INST_DEFINE(index, \ |
| &dma_stm32_init, \ |
| NULL, \ |
| &dma_stm32_data_##index, &dma_stm32_config_##index, \ |
| PRE_KERNEL_1, CONFIG_DMA_INIT_PRIORITY, \ |
| &dma_funcs); |
| |
| DT_INST_FOREACH_STATUS_OKAY(DMA_STM32_INIT_DEV) |