kopia lustrzana https://github.com/espressif/esp-idf
122 wiersze
4.0 KiB
C
122 wiersze
4.0 KiB
C
![]() |
/*
|
||
|
* SPDX-FileCopyrightText: 2020-2022 Espressif Systems (Shanghai) CO LTD
|
||
|
*
|
||
|
* SPDX-License-Identifier: Apache-2.0
|
||
|
*/
|
||
|
|
||
|
// #define LOG_LOCAL_LEVEL ESP_LOG_DEBUG
|
||
|
|
||
|
#include <stdlib.h>
|
||
|
#include <sys/cdefs.h>
|
||
|
#include "sdkconfig.h"
|
||
|
#include "esp_log.h"
|
||
|
#include "esp_check.h"
|
||
|
#include "esp_heap_caps.h"
|
||
|
#include "hal/gdma_hal.h"
|
||
|
#include "hal/gdma_ll.h"
|
||
|
#include "soc/gdma_periph.h"
|
||
|
#include "esp_private/gdma.h"
|
||
|
#include "esp_private/etm_interface.h"
|
||
|
#include "gdma_priv.h"
|
||
|
|
||
|
#define ETM_MEM_ALLOC_CAPS MALLOC_CAP_DEFAULT
|
||
|
|
||
|
static const char *TAG = "gdma-etm";
|
||
|
|
||
|
typedef struct gdma_etm_task_t {
|
||
|
esp_etm_task_t base;
|
||
|
gdma_channel_t *chan;
|
||
|
} gdma_etm_task_t;
|
||
|
|
||
|
static esp_err_t gdma_del_etm_event(esp_etm_event_t *event)
|
||
|
{
|
||
|
free(event);
|
||
|
return ESP_OK;
|
||
|
}
|
||
|
|
||
|
static esp_err_t gdma_del_etm_task(esp_etm_task_t *task)
|
||
|
{
|
||
|
gdma_etm_task_t *gdma_task = __containerof(task, gdma_etm_task_t, base);
|
||
|
gdma_channel_t *dma_chan = gdma_task->chan;
|
||
|
gdma_pair_t *pair = dma_chan->pair;
|
||
|
gdma_group_t *group = pair->group;
|
||
|
if (dma_chan->direction == GDMA_CHANNEL_DIRECTION_RX) {
|
||
|
gdma_ll_rx_enable_etm_task(group->hal.dev, pair->pair_id, false);
|
||
|
} else {
|
||
|
gdma_ll_tx_enable_etm_task(group->hal.dev, pair->pair_id, false);
|
||
|
}
|
||
|
free(gdma_task);
|
||
|
return ESP_OK;
|
||
|
}
|
||
|
|
||
|
esp_err_t gdma_new_etm_event(gdma_channel_handle_t dma_chan, gdma_etm_event_type_t event_type, esp_etm_event_handle_t *out_event)
|
||
|
{
|
||
|
esp_etm_event_t *event = NULL;
|
||
|
esp_err_t ret = ESP_OK;
|
||
|
ESP_GOTO_ON_FALSE(dma_chan && out_event, ESP_ERR_INVALID_ARG, err, TAG, "invalid argument");
|
||
|
ESP_GOTO_ON_FALSE(event_type < GDMA_ETM_EVENT_MAX, ESP_ERR_INVALID_ARG, err, TAG, "invalid event type");
|
||
|
event = heap_caps_calloc(1, sizeof(esp_etm_event_t), ETM_MEM_ALLOC_CAPS);
|
||
|
ESP_GOTO_ON_FALSE(event, ESP_ERR_NO_MEM, err, TAG, "no memory for ETM event");
|
||
|
|
||
|
gdma_pair_t *pair = dma_chan->pair;
|
||
|
gdma_group_t *group = pair->group;
|
||
|
uint32_t event_id = 0;
|
||
|
|
||
|
if (dma_chan->direction == GDMA_CHANNEL_DIRECTION_RX) {
|
||
|
event_id = GDMA_LL_RX_ETM_EVENT_TABLE(group->group_id, pair->pair_id, event_type);
|
||
|
} else {
|
||
|
event_id = GDMA_LL_TX_ETM_EVENT_TABLE(group->group_id, pair->pair_id, event_type);
|
||
|
}
|
||
|
ESP_GOTO_ON_FALSE(event_id != 0, ESP_ERR_NOT_SUPPORTED, err, TAG, "not supported event type");
|
||
|
|
||
|
// fill the ETM event object
|
||
|
event->event_id = event_id;
|
||
|
event->trig_periph = ETM_TRIG_PERIPH_GDMA;
|
||
|
event->del = gdma_del_etm_event;
|
||
|
*out_event = event;
|
||
|
return ESP_OK;
|
||
|
|
||
|
err:
|
||
|
if (event) {
|
||
|
gdma_del_etm_event(event);
|
||
|
}
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
esp_err_t gdma_new_etm_task(gdma_channel_handle_t dma_chan, gdma_etm_task_type_t task_type, esp_etm_task_handle_t *out_task)
|
||
|
{
|
||
|
gdma_etm_task_t *task = NULL;
|
||
|
esp_err_t ret = ESP_OK;
|
||
|
ESP_GOTO_ON_FALSE(dma_chan && out_task, ESP_ERR_INVALID_ARG, err, TAG, "invalid argument");
|
||
|
ESP_GOTO_ON_FALSE(task_type < GDMA_ETM_TASK_MAX, ESP_ERR_INVALID_ARG, err, TAG, "invalid task type");
|
||
|
task = heap_caps_calloc(1, sizeof(gdma_etm_task_t), ETM_MEM_ALLOC_CAPS);
|
||
|
ESP_GOTO_ON_FALSE(task, ESP_ERR_NO_MEM, err, TAG, "no memory for ETM task");
|
||
|
|
||
|
gdma_pair_t *pair = dma_chan->pair;
|
||
|
gdma_group_t *group = pair->group;
|
||
|
uint32_t task_id = 0;
|
||
|
|
||
|
if (dma_chan->direction == GDMA_CHANNEL_DIRECTION_RX) {
|
||
|
task_id = GDMA_LL_RX_ETM_TASK_TABLE(group->group_id, pair->pair_id, task_type);
|
||
|
gdma_ll_rx_enable_etm_task(group->hal.dev, pair->pair_id, true);
|
||
|
} else {
|
||
|
task_id = GDMA_LL_TX_ETM_TASK_TABLE(group->group_id, pair->pair_id, task_type);
|
||
|
gdma_ll_tx_enable_etm_task(group->hal.dev, pair->pair_id, true);
|
||
|
}
|
||
|
ESP_GOTO_ON_FALSE(task_id != 0, ESP_ERR_NOT_SUPPORTED, err, TAG, "not supported task type");
|
||
|
|
||
|
// fill the ETM task object
|
||
|
task->chan = dma_chan;
|
||
|
task->base.task_id = task_id;
|
||
|
task->base.trig_periph = ETM_TRIG_PERIPH_GDMA;
|
||
|
task->base.del = gdma_del_etm_task;
|
||
|
*out_task = &(task->base);
|
||
|
return ESP_OK;
|
||
|
|
||
|
err:
|
||
|
if (task) {
|
||
|
gdma_del_etm_task(&task->base);
|
||
|
}
|
||
|
return ret;
|
||
|
}
|