|
|
@@ -36,14 +36,10 @@
|
|
|
return (ret_val); \
|
|
|
} \
|
|
|
})
|
|
|
-#define TWAI_CHECK_FROM_CRIT(cond, ret_val) ({ \
|
|
|
- if (!(cond)) { \
|
|
|
- TWAI_EXIT_CRITICAL(); \
|
|
|
- return ret_val; \
|
|
|
- } \
|
|
|
-})
|
|
|
+
|
|
|
#define TWAI_SET_FLAG(var, mask) ((var) |= (mask))
|
|
|
#define TWAI_RESET_FLAG(var, mask) ((var) &= ~(mask))
|
|
|
+
|
|
|
#ifdef CONFIG_TWAI_ISR_IN_IRAM
|
|
|
#define TWAI_MALLOC_CAPS (MALLOC_CAP_INTERNAL | MALLOC_CAP_8BIT)
|
|
|
#else
|
|
|
@@ -65,8 +61,9 @@
|
|
|
/* ------------------ Typedefs, structures, and variables ------------------- */
|
|
|
|
|
|
//Control structure for TWAI driver
|
|
|
-typedef struct {
|
|
|
+typedef struct twai_obj_t {
|
|
|
int controller_id;
|
|
|
+ twai_hal_context_t hal; // hal context
|
|
|
//Control and status members
|
|
|
twai_state_t state;
|
|
|
twai_mode_t mode;
|
|
|
@@ -87,20 +84,15 @@ typedef struct {
|
|
|
uint32_t alerts_triggered;
|
|
|
//Power Management Lock
|
|
|
esp_pm_lock_handle_t pm_lock;
|
|
|
+ portMUX_TYPE spinlock;
|
|
|
} twai_obj_t;
|
|
|
|
|
|
-static twai_obj_t *p_twai_obj = NULL;
|
|
|
-static portMUX_TYPE twai_spinlock = portMUX_INITIALIZER_UNLOCKED;
|
|
|
-#define TWAI_ENTER_CRITICAL_ISR() portENTER_CRITICAL_ISR(&twai_spinlock)
|
|
|
-#define TWAI_EXIT_CRITICAL_ISR() portEXIT_CRITICAL_ISR(&twai_spinlock)
|
|
|
-#define TWAI_ENTER_CRITICAL() portENTER_CRITICAL(&twai_spinlock)
|
|
|
-#define TWAI_EXIT_CRITICAL() portEXIT_CRITICAL(&twai_spinlock)
|
|
|
-
|
|
|
-static twai_hal_context_t twai_context;
|
|
|
+static twai_handle_t g_twai_objs[SOC_TWAI_CONTROLLER_NUM];
|
|
|
+static portMUX_TYPE g_spinlock = portMUX_INITIALIZER_UNLOCKED;
|
|
|
|
|
|
/* -------------------- Interrupt and Alert Handlers ------------------------ */
|
|
|
|
|
|
-static void twai_alert_handler(uint32_t alert_code, int *alert_req)
|
|
|
+static void twai_alert_handler(twai_obj_t *p_twai_obj, uint32_t alert_code, int *alert_req)
|
|
|
{
|
|
|
if (p_twai_obj->alerts_enabled & alert_code) {
|
|
|
//Signify alert has occurred
|
|
|
@@ -120,41 +112,41 @@ static void twai_alert_handler(uint32_t alert_code, int *alert_req)
|
|
|
}
|
|
|
}
|
|
|
|
|
|
-static inline void twai_handle_rx_buffer_frames(BaseType_t *task_woken, int *alert_req)
|
|
|
+static inline void twai_handle_rx_buffer_frames(twai_obj_t *p_twai_obj, BaseType_t *task_woken, int *alert_req)
|
|
|
{
|
|
|
#ifdef SOC_TWAI_SUPPORTS_RX_STATUS
|
|
|
- uint32_t msg_count = twai_hal_get_rx_msg_count(&twai_context);
|
|
|
+ uint32_t msg_count = twai_hal_get_rx_msg_count(&p_twai_obj->hal);
|
|
|
|
|
|
for (uint32_t i = 0; i < msg_count; i++) {
|
|
|
twai_hal_frame_t frame;
|
|
|
- if (twai_hal_read_rx_buffer_and_clear(&twai_context, &frame)) {
|
|
|
+ if (twai_hal_read_rx_buffer_and_clear(&p_twai_obj->hal, &frame)) {
|
|
|
//Valid frame copied from RX buffer
|
|
|
if (xQueueSendFromISR(p_twai_obj->rx_queue, &frame, task_woken) == pdTRUE) {
|
|
|
p_twai_obj->rx_msg_count++;
|
|
|
- twai_alert_handler(TWAI_ALERT_RX_DATA, alert_req);
|
|
|
+ twai_alert_handler(p_twai_obj, TWAI_ALERT_RX_DATA, alert_req);
|
|
|
} else { //Failed to send to queue
|
|
|
p_twai_obj->rx_missed_count++;
|
|
|
- twai_alert_handler(TWAI_ALERT_RX_QUEUE_FULL, alert_req);
|
|
|
+ twai_alert_handler(p_twai_obj, TWAI_ALERT_RX_QUEUE_FULL, alert_req);
|
|
|
}
|
|
|
} else { //Failed to read from RX buffer because message is overrun
|
|
|
p_twai_obj->rx_overrun_count++;
|
|
|
- twai_alert_handler(TWAI_ALERT_RX_FIFO_OVERRUN, alert_req);
|
|
|
+ twai_alert_handler(p_twai_obj, TWAI_ALERT_RX_FIFO_OVERRUN, alert_req);
|
|
|
}
|
|
|
}
|
|
|
#else //SOC_TWAI_SUPPORTS_RX_STATUS
|
|
|
- uint32_t msg_count = twai_hal_get_rx_msg_count(&twai_context);
|
|
|
+ uint32_t msg_count = twai_hal_get_rx_msg_count(&p_twai_obj->hal);
|
|
|
bool overrun = false;
|
|
|
//Clear all valid RX frames
|
|
|
for (int i = 0; i < msg_count; i++) {
|
|
|
twai_hal_frame_t frame;
|
|
|
- if (twai_hal_read_rx_buffer_and_clear(&twai_context, &frame)) {
|
|
|
+ if (twai_hal_read_rx_buffer_and_clear(&p_twai_obj->hal, &frame)) {
|
|
|
//Valid frame copied from RX buffer
|
|
|
if (xQueueSendFromISR(p_twai_obj->rx_queue, &frame, task_woken) == pdTRUE) {
|
|
|
p_twai_obj->rx_msg_count++;
|
|
|
- twai_alert_handler(TWAI_ALERT_RX_DATA, alert_req);
|
|
|
+ twai_alert_handler(p_twai_obj, TWAI_ALERT_RX_DATA, alert_req);
|
|
|
} else {
|
|
|
p_twai_obj->rx_missed_count++;
|
|
|
- twai_alert_handler(TWAI_ALERT_RX_QUEUE_FULL, alert_req);
|
|
|
+ twai_alert_handler(p_twai_obj, TWAI_ALERT_RX_QUEUE_FULL, alert_req);
|
|
|
}
|
|
|
} else {
|
|
|
overrun = true;
|
|
|
@@ -163,20 +155,20 @@ static inline void twai_handle_rx_buffer_frames(BaseType_t *task_woken, int *ale
|
|
|
}
|
|
|
//All remaining frames are treated as overrun. Clear them all
|
|
|
if (overrun) {
|
|
|
- p_twai_obj->rx_overrun_count += twai_hal_clear_rx_fifo_overrun(&twai_context);
|
|
|
- twai_alert_handler(TWAI_ALERT_RX_FIFO_OVERRUN, alert_req);
|
|
|
+ p_twai_obj->rx_overrun_count += twai_hal_clear_rx_fifo_overrun(&p_twai_obj->hal);
|
|
|
+ twai_alert_handler(p_twai_obj, TWAI_ALERT_RX_FIFO_OVERRUN, alert_req);
|
|
|
}
|
|
|
#endif //SOC_TWAI_SUPPORTS_RX_STATUS
|
|
|
}
|
|
|
|
|
|
-static inline void twai_handle_tx_buffer_frame(BaseType_t *task_woken, int *alert_req)
|
|
|
+static inline void twai_handle_tx_buffer_frame(twai_obj_t *p_twai_obj, BaseType_t *task_woken, int *alert_req)
|
|
|
{
|
|
|
//Handle previously transmitted frame
|
|
|
- if (twai_hal_check_last_tx_successful(&twai_context)) {
|
|
|
- twai_alert_handler(TWAI_ALERT_TX_SUCCESS, alert_req);
|
|
|
+ if (twai_hal_check_last_tx_successful(&p_twai_obj->hal)) {
|
|
|
+ twai_alert_handler(p_twai_obj, TWAI_ALERT_TX_SUCCESS, alert_req);
|
|
|
} else {
|
|
|
p_twai_obj->tx_failed_count++;
|
|
|
- twai_alert_handler(TWAI_ALERT_TX_FAILED, alert_req);
|
|
|
+ twai_alert_handler(p_twai_obj, TWAI_ALERT_TX_FAILED, alert_req);
|
|
|
}
|
|
|
|
|
|
//Update TX message count
|
|
|
@@ -188,86 +180,83 @@ static inline void twai_handle_tx_buffer_frame(BaseType_t *task_woken, int *aler
|
|
|
twai_hal_frame_t frame;
|
|
|
int res = xQueueReceiveFromISR(p_twai_obj->tx_queue, &frame, task_woken);
|
|
|
if (res == pdTRUE) {
|
|
|
- twai_hal_set_tx_buffer_and_transmit(&twai_context, &frame);
|
|
|
+ twai_hal_set_tx_buffer_and_transmit(&p_twai_obj->hal, &frame);
|
|
|
} else {
|
|
|
assert(false && "failed to get a frame from TX queue");
|
|
|
}
|
|
|
} else {
|
|
|
//No more frames to transmit
|
|
|
- twai_alert_handler(TWAI_ALERT_TX_IDLE, alert_req);
|
|
|
+ twai_alert_handler(p_twai_obj, TWAI_ALERT_TX_IDLE, alert_req);
|
|
|
}
|
|
|
}
|
|
|
|
|
|
static void twai_intr_handler_main(void *arg)
|
|
|
{
|
|
|
+ twai_obj_t *p_twai_obj = (twai_obj_t *)arg;
|
|
|
BaseType_t task_woken = pdFALSE;
|
|
|
int alert_req = 0;
|
|
|
uint32_t events;
|
|
|
- TWAI_ENTER_CRITICAL_ISR();
|
|
|
- if (p_twai_obj == NULL) { //In case intr occurs whilst driver is being uninstalled
|
|
|
- TWAI_EXIT_CRITICAL_ISR();
|
|
|
- return;
|
|
|
- }
|
|
|
- events = twai_hal_get_events(&twai_context); //Get the events that triggered the interrupt
|
|
|
+ portENTER_CRITICAL_ISR(&p_twai_obj->spinlock);
|
|
|
+ events = twai_hal_get_events(&p_twai_obj->hal); //Get the events that triggered the interrupt
|
|
|
|
|
|
#if defined(CONFIG_TWAI_ERRATA_FIX_RX_FRAME_INVALID) || defined(CONFIG_TWAI_ERRATA_FIX_RX_FIFO_CORRUPT)
|
|
|
if (events & TWAI_HAL_EVENT_NEED_PERIPH_RESET) {
|
|
|
- twai_hal_prepare_for_reset(&twai_context);
|
|
|
+ twai_hal_prepare_for_reset(&p_twai_obj->hal);
|
|
|
TWAI_RCC_ATOMIC() {
|
|
|
twai_ll_reset_register(p_twai_obj->controller_id);
|
|
|
}
|
|
|
- twai_hal_recover_from_reset(&twai_context);
|
|
|
- p_twai_obj->rx_missed_count += twai_hal_get_reset_lost_rx_cnt(&twai_context);
|
|
|
- twai_alert_handler(TWAI_ALERT_PERIPH_RESET, &alert_req);
|
|
|
+ twai_hal_recover_from_reset(&p_twai_obj->hal);
|
|
|
+ p_twai_obj->rx_missed_count += twai_hal_get_reset_lost_rx_cnt(&p_twai_obj->hal);
|
|
|
+ twai_alert_handler(p_twai_obj, TWAI_ALERT_PERIPH_RESET, &alert_req);
|
|
|
}
|
|
|
#endif
|
|
|
if (events & TWAI_HAL_EVENT_RX_BUFF_FRAME) {
|
|
|
//Note: This event will never occur if there is a periph reset event
|
|
|
- twai_handle_rx_buffer_frames(&task_woken, &alert_req);
|
|
|
+ twai_handle_rx_buffer_frames(p_twai_obj, &task_woken, &alert_req);
|
|
|
}
|
|
|
if (events & TWAI_HAL_EVENT_TX_BUFF_FREE) {
|
|
|
- twai_handle_tx_buffer_frame(&task_woken, &alert_req);
|
|
|
+ twai_handle_tx_buffer_frame(p_twai_obj, &task_woken, &alert_req);
|
|
|
}
|
|
|
|
|
|
//Handle events that only require alerting (i.e. no handler)
|
|
|
if (events & TWAI_HAL_EVENT_BUS_OFF) {
|
|
|
p_twai_obj->state = TWAI_STATE_BUS_OFF;
|
|
|
- twai_alert_handler(TWAI_ALERT_BUS_OFF, &alert_req);
|
|
|
+ twai_alert_handler(p_twai_obj, TWAI_ALERT_BUS_OFF, &alert_req);
|
|
|
}
|
|
|
if (events & TWAI_HAL_EVENT_BUS_RECOV_CPLT) {
|
|
|
p_twai_obj->state = TWAI_STATE_STOPPED;
|
|
|
- twai_alert_handler(TWAI_ALERT_BUS_RECOVERED, &alert_req);
|
|
|
+ twai_alert_handler(p_twai_obj, TWAI_ALERT_BUS_RECOVERED, &alert_req);
|
|
|
}
|
|
|
if (events & TWAI_HAL_EVENT_BUS_ERR) {
|
|
|
p_twai_obj->bus_error_count++;
|
|
|
- twai_alert_handler(TWAI_ALERT_BUS_ERROR, &alert_req);
|
|
|
+ twai_alert_handler(p_twai_obj, TWAI_ALERT_BUS_ERROR, &alert_req);
|
|
|
}
|
|
|
if (events & TWAI_HAL_EVENT_ARB_LOST) {
|
|
|
p_twai_obj->arb_lost_count++;
|
|
|
- twai_alert_handler(TWAI_ALERT_ARB_LOST, &alert_req);
|
|
|
+ twai_alert_handler(p_twai_obj, TWAI_ALERT_ARB_LOST, &alert_req);
|
|
|
}
|
|
|
if (events & TWAI_HAL_EVENT_BUS_RECOV_PROGRESS) {
|
|
|
//Bus-recovery in progress. TEC has dropped below error warning limit
|
|
|
- twai_alert_handler(TWAI_ALERT_RECOVERY_IN_PROGRESS, &alert_req);
|
|
|
+ twai_alert_handler(p_twai_obj, TWAI_ALERT_RECOVERY_IN_PROGRESS, &alert_req);
|
|
|
}
|
|
|
if (events & TWAI_HAL_EVENT_ERROR_PASSIVE) {
|
|
|
//Entered error passive
|
|
|
- twai_alert_handler(TWAI_ALERT_ERR_PASS, &alert_req);
|
|
|
+ twai_alert_handler(p_twai_obj, TWAI_ALERT_ERR_PASS, &alert_req);
|
|
|
}
|
|
|
if (events & TWAI_HAL_EVENT_ERROR_ACTIVE) {
|
|
|
//Returned to error active
|
|
|
- twai_alert_handler(TWAI_ALERT_ERR_ACTIVE, &alert_req);
|
|
|
+ twai_alert_handler(p_twai_obj, TWAI_ALERT_ERR_ACTIVE, &alert_req);
|
|
|
}
|
|
|
if (events & TWAI_HAL_EVENT_ABOVE_EWL) {
|
|
|
//TEC or REC surpassed error warning limit
|
|
|
- twai_alert_handler(TWAI_ALERT_ABOVE_ERR_WARN, &alert_req);
|
|
|
+ twai_alert_handler(p_twai_obj, TWAI_ALERT_ABOVE_ERR_WARN, &alert_req);
|
|
|
}
|
|
|
if (events & TWAI_HAL_EVENT_BELOW_EWL) {
|
|
|
//TEC and REC are both below error warning
|
|
|
- twai_alert_handler(TWAI_ALERT_BELOW_ERR_WARN, &alert_req);
|
|
|
+ twai_alert_handler(p_twai_obj, TWAI_ALERT_BELOW_ERR_WARN, &alert_req);
|
|
|
}
|
|
|
|
|
|
- TWAI_EXIT_CRITICAL_ISR();
|
|
|
+ portEXIT_CRITICAL_ISR(&p_twai_obj->spinlock);
|
|
|
|
|
|
if (p_twai_obj->alert_semphr != NULL && alert_req) {
|
|
|
//Give semaphore if alerts were triggered
|
|
|
@@ -280,11 +269,10 @@ static void twai_intr_handler_main(void *arg)
|
|
|
|
|
|
/* -------------------------- Helper functions ----------------------------- */
|
|
|
|
|
|
-static void twai_configure_gpio(gpio_num_t tx, gpio_num_t rx, gpio_num_t clkout, gpio_num_t bus_status)
|
|
|
+static void twai_configure_gpio(int controller_id, gpio_num_t tx, gpio_num_t rx, gpio_num_t clkout, gpio_num_t bus_status)
|
|
|
{
|
|
|
// assert the GPIO number is not a negative number (shift operation on a negative number is undefined)
|
|
|
assert(tx >= 0 && rx >= 0);
|
|
|
- int controller_id = p_twai_obj->controller_id;
|
|
|
// if TX and RX set to the same GPIO, which means we want to create a loop-back in the GPIO matrix
|
|
|
bool io_loop_back = (tx == rx);
|
|
|
gpio_config_t gpio_conf = {
|
|
|
@@ -366,7 +354,7 @@ static esp_err_t twai_alloc_driver_obj(const twai_general_config_t *g_config, tw
|
|
|
ret = esp_intr_alloc(twai_controller_periph_signals.controllers[controller_id].irq_id,
|
|
|
g_config->intr_flags | ESP_INTR_FLAG_INTRDISABLED,
|
|
|
twai_intr_handler_main,
|
|
|
- NULL,
|
|
|
+ p_obj,
|
|
|
&p_obj->isr_handle);
|
|
|
if (ret != ESP_OK) {
|
|
|
goto err;
|
|
|
@@ -399,22 +387,21 @@ err:
|
|
|
}
|
|
|
|
|
|
/* ---------------------------- Public Functions ---------------------------- */
|
|
|
-
|
|
|
-esp_err_t twai_driver_install(const twai_general_config_t *g_config, const twai_timing_config_t *t_config, const twai_filter_config_t *f_config)
|
|
|
+esp_err_t twai_driver_install_v2(const twai_general_config_t *g_config, const twai_timing_config_t *t_config, const twai_filter_config_t *f_config, twai_handle_t *ret_twai)
|
|
|
{
|
|
|
//Check arguments
|
|
|
TWAI_CHECK(g_config != NULL, ESP_ERR_INVALID_ARG);
|
|
|
TWAI_CHECK(t_config != NULL, ESP_ERR_INVALID_ARG);
|
|
|
TWAI_CHECK(f_config != NULL, ESP_ERR_INVALID_ARG);
|
|
|
+ TWAI_CHECK(g_config->controller_id < SOC_TWAI_CONTROLLER_NUM, ESP_ERR_INVALID_ARG);
|
|
|
TWAI_CHECK(g_config->rx_queue_len > 0, ESP_ERR_INVALID_ARG);
|
|
|
TWAI_CHECK(GPIO_IS_VALID_OUTPUT_GPIO(g_config->tx_io), ESP_ERR_INVALID_ARG);
|
|
|
TWAI_CHECK(GPIO_IS_VALID_GPIO(g_config->rx_io), ESP_ERR_INVALID_ARG);
|
|
|
#ifndef CONFIG_TWAI_ISR_IN_IRAM
|
|
|
TWAI_CHECK(!(g_config->intr_flags & ESP_INTR_FLAG_IRAM), ESP_ERR_INVALID_ARG);
|
|
|
#endif
|
|
|
- TWAI_ENTER_CRITICAL();
|
|
|
- TWAI_CHECK_FROM_CRIT(p_twai_obj == NULL, ESP_ERR_INVALID_STATE);
|
|
|
- TWAI_EXIT_CRITICAL();
|
|
|
+ int controller_id = g_config->controller_id;
|
|
|
+ TWAI_CHECK(g_twai_objs[controller_id] == NULL, ESP_ERR_INVALID_STATE);
|
|
|
|
|
|
//Get clock source resolution
|
|
|
uint32_t clock_source_hz = 0;
|
|
|
@@ -434,36 +421,37 @@ esp_err_t twai_driver_install(const twai_general_config_t *g_config, const twai_
|
|
|
TWAI_CHECK(twai_ll_check_brp_validation(brp), ESP_ERR_INVALID_ARG);
|
|
|
|
|
|
esp_err_t ret;
|
|
|
- twai_obj_t *p_twai_obj_dummy;
|
|
|
- // TODO: Currently only controller 0 is supported by the driver. IDF-4775
|
|
|
- const int controller_id = 0;
|
|
|
+ twai_obj_t *p_twai_obj;
|
|
|
|
|
|
//Create a TWAI object (including queues, semaphores, interrupts, and PM locks)
|
|
|
- ret = twai_alloc_driver_obj(g_config, clk_src, controller_id, &p_twai_obj_dummy);
|
|
|
+ ret = twai_alloc_driver_obj(g_config, clk_src, controller_id, &p_twai_obj);
|
|
|
if (ret != ESP_OK) {
|
|
|
return ret;
|
|
|
}
|
|
|
|
|
|
//Initialize flags and variables. All other members are already set to zero by twai_alloc_driver_obj()
|
|
|
- p_twai_obj_dummy->controller_id = controller_id;
|
|
|
- p_twai_obj_dummy->state = TWAI_STATE_STOPPED;
|
|
|
- p_twai_obj_dummy->mode = g_config->mode;
|
|
|
- p_twai_obj_dummy->alerts_enabled = g_config->alerts_enabled;
|
|
|
+ portMUX_INITIALIZE(&p_twai_obj->spinlock);
|
|
|
+ p_twai_obj->controller_id = controller_id;
|
|
|
+ p_twai_obj->state = TWAI_STATE_STOPPED;
|
|
|
+ p_twai_obj->mode = g_config->mode;
|
|
|
+ p_twai_obj->alerts_enabled = g_config->alerts_enabled;
|
|
|
|
|
|
//Assign the TWAI object
|
|
|
- TWAI_ENTER_CRITICAL();
|
|
|
- if (p_twai_obj == NULL) {
|
|
|
- p_twai_obj = p_twai_obj_dummy;
|
|
|
+ portENTER_CRITICAL(&g_spinlock);
|
|
|
+ if (g_twai_objs[controller_id] == NULL) {
|
|
|
+ g_twai_objs[controller_id] = p_twai_obj;
|
|
|
} else {
|
|
|
//Check if driver is already installed
|
|
|
- TWAI_EXIT_CRITICAL();
|
|
|
+ portEXIT_CRITICAL(&g_spinlock);
|
|
|
ret = ESP_ERR_INVALID_STATE;
|
|
|
goto err;
|
|
|
}
|
|
|
+ portEXIT_CRITICAL(&g_spinlock);
|
|
|
+
|
|
|
//Enable TWAI peripheral register clock
|
|
|
TWAI_RCC_ATOMIC() {
|
|
|
- twai_ll_enable_bus_clock(p_twai_obj->controller_id, true);
|
|
|
- twai_ll_reset_register(p_twai_obj->controller_id);
|
|
|
+ twai_ll_enable_bus_clock(controller_id, true);
|
|
|
+ twai_ll_reset_register(controller_id);
|
|
|
}
|
|
|
|
|
|
//Initialize TWAI HAL layer
|
|
|
@@ -471,65 +459,95 @@ esp_err_t twai_driver_install(const twai_general_config_t *g_config, const twai_
|
|
|
.clock_source_hz = clock_source_hz,
|
|
|
.controller_id = controller_id,
|
|
|
};
|
|
|
- bool res = twai_hal_init(&twai_context, &hal_config);
|
|
|
+ bool res = twai_hal_init(&p_twai_obj->hal, &hal_config);
|
|
|
assert(res);
|
|
|
- twai_hal_configure(&twai_context, t_config, f_config, DRIVER_DEFAULT_INTERRUPTS, g_config->clkout_divider);
|
|
|
- TWAI_EXIT_CRITICAL();
|
|
|
+ twai_hal_configure(&p_twai_obj->hal, t_config, f_config, DRIVER_DEFAULT_INTERRUPTS, g_config->clkout_divider);
|
|
|
|
|
|
//Assign GPIO and Interrupts
|
|
|
- twai_configure_gpio(g_config->tx_io, g_config->rx_io, g_config->clkout_io, g_config->bus_off_io);
|
|
|
+ twai_configure_gpio(controller_id, g_config->tx_io, g_config->rx_io, g_config->clkout_io, g_config->bus_off_io);
|
|
|
+
|
|
|
#if CONFIG_PM_ENABLE
|
|
|
//Acquire PM lock
|
|
|
if (p_twai_obj->pm_lock) {
|
|
|
ESP_ERROR_CHECK(esp_pm_lock_acquire(p_twai_obj->pm_lock)); //Acquire pm_lock during the whole driver lifetime
|
|
|
}
|
|
|
#endif //CONFIG_PM_ENABLE
|
|
|
+
|
|
|
//Enable interrupt
|
|
|
ESP_ERROR_CHECK(esp_intr_enable(p_twai_obj->isr_handle));
|
|
|
|
|
|
+ *ret_twai = p_twai_obj;
|
|
|
+
|
|
|
return ESP_OK; //TWAI module is still in reset mode, users need to call twai_start() afterwards
|
|
|
|
|
|
err:
|
|
|
- twai_free_driver_obj(p_twai_obj_dummy);
|
|
|
+ twai_free_driver_obj(p_twai_obj);
|
|
|
return ret;
|
|
|
}
|
|
|
|
|
|
-esp_err_t twai_driver_uninstall(void)
|
|
|
+esp_err_t twai_driver_install(const twai_general_config_t *g_config, const twai_timing_config_t *t_config, const twai_filter_config_t *f_config)
|
|
|
+{
|
|
|
+ // the handle-less driver API only supports one TWAI controller, i.e. the g_twai_objs[0]
|
|
|
+ TWAI_CHECK(g_config->controller_id == 0, ESP_ERR_INVALID_ARG);
|
|
|
+ return twai_driver_install_v2(g_config, t_config, f_config, &g_twai_objs[0]);
|
|
|
+}
|
|
|
+
|
|
|
+esp_err_t twai_driver_uninstall_v2(twai_handle_t handle)
|
|
|
{
|
|
|
- twai_obj_t *p_twai_obj_dummy;
|
|
|
+ TWAI_CHECK(handle != NULL, ESP_ERR_INVALID_ARG);
|
|
|
+ int controller_id = handle->controller_id;
|
|
|
+ twai_obj_t *p_twai_obj;
|
|
|
|
|
|
- TWAI_ENTER_CRITICAL();
|
|
|
+ portENTER_CRITICAL(&g_spinlock);
|
|
|
//Check state
|
|
|
- TWAI_CHECK_FROM_CRIT(p_twai_obj != NULL, ESP_ERR_INVALID_STATE);
|
|
|
- TWAI_CHECK_FROM_CRIT(p_twai_obj->state == TWAI_STATE_STOPPED || p_twai_obj->state == TWAI_STATE_BUS_OFF, ESP_ERR_INVALID_STATE);
|
|
|
+ if (g_twai_objs[controller_id] == NULL) {
|
|
|
+ portEXIT_CRITICAL(&g_spinlock);
|
|
|
+ return ESP_ERR_INVALID_STATE;
|
|
|
+ }
|
|
|
+ p_twai_obj = g_twai_objs[controller_id];
|
|
|
+ if (!(p_twai_obj->state == TWAI_STATE_STOPPED || p_twai_obj->state == TWAI_STATE_BUS_OFF)) {
|
|
|
+ portEXIT_CRITICAL(&g_spinlock);
|
|
|
+ return ESP_ERR_INVALID_STATE;
|
|
|
+ }
|
|
|
+ g_twai_objs[controller_id] = NULL;
|
|
|
+ portEXIT_CRITICAL(&g_spinlock);
|
|
|
+
|
|
|
//Clear registers by reading
|
|
|
- twai_hal_deinit(&twai_context);
|
|
|
+ twai_hal_deinit(&p_twai_obj->hal);
|
|
|
TWAI_RCC_ATOMIC() {
|
|
|
- twai_ll_enable_bus_clock(p_twai_obj->controller_id, false);
|
|
|
+ twai_ll_enable_bus_clock(controller_id, false);
|
|
|
}
|
|
|
- p_twai_obj_dummy = p_twai_obj; //Use dummy to shorten critical section
|
|
|
- p_twai_obj = NULL;
|
|
|
- TWAI_EXIT_CRITICAL();
|
|
|
|
|
|
#if CONFIG_PM_ENABLE
|
|
|
- if (p_twai_obj_dummy->pm_lock) {
|
|
|
+ if (p_twai_obj->pm_lock) {
|
|
|
//Release and delete power management lock
|
|
|
- ESP_ERROR_CHECK(esp_pm_lock_release(p_twai_obj_dummy->pm_lock));
|
|
|
+ ESP_ERROR_CHECK(esp_pm_lock_release(p_twai_obj->pm_lock));
|
|
|
}
|
|
|
#endif //CONFIG_PM_ENABLE
|
|
|
+
|
|
|
//Disable interrupt
|
|
|
- ESP_ERROR_CHECK(esp_intr_disable(p_twai_obj_dummy->isr_handle));
|
|
|
- //Free can driver object
|
|
|
- twai_free_driver_obj(p_twai_obj_dummy);
|
|
|
+ ESP_ERROR_CHECK(esp_intr_disable(p_twai_obj->isr_handle));
|
|
|
+ //Free twai driver object
|
|
|
+ twai_free_driver_obj(p_twai_obj);
|
|
|
return ESP_OK;
|
|
|
}
|
|
|
|
|
|
-esp_err_t twai_start(void)
|
|
|
+esp_err_t twai_driver_uninstall(void)
|
|
|
{
|
|
|
- //Check state
|
|
|
- TWAI_ENTER_CRITICAL();
|
|
|
- TWAI_CHECK_FROM_CRIT(p_twai_obj != NULL, ESP_ERR_INVALID_STATE);
|
|
|
- TWAI_CHECK_FROM_CRIT(p_twai_obj->state == TWAI_STATE_STOPPED, ESP_ERR_INVALID_STATE);
|
|
|
+ // the handle-less driver API only support one TWAI controller, i.e. the g_twai_objs[0]
|
|
|
+ return twai_driver_uninstall_v2(g_twai_objs[0]);
|
|
|
+}
|
|
|
+
|
|
|
+esp_err_t twai_start_v2(twai_handle_t handle)
|
|
|
+{
|
|
|
+ TWAI_CHECK(handle != NULL, ESP_ERR_INVALID_ARG);
|
|
|
+ twai_obj_t *p_twai_obj = handle;
|
|
|
+
|
|
|
+ portENTER_CRITICAL(&handle->spinlock);
|
|
|
+ if (p_twai_obj->state != TWAI_STATE_STOPPED) {
|
|
|
+ portEXIT_CRITICAL(&handle->spinlock);
|
|
|
+ return ESP_ERR_INVALID_STATE;
|
|
|
+ }
|
|
|
|
|
|
//Reset RX queue, RX message count, amd TX queue
|
|
|
xQueueReset(p_twai_obj->rx_queue);
|
|
|
@@ -538,21 +556,32 @@ esp_err_t twai_start(void)
|
|
|
}
|
|
|
p_twai_obj->rx_msg_count = 0;
|
|
|
p_twai_obj->tx_msg_count = 0;
|
|
|
- twai_hal_start(&twai_context, p_twai_obj->mode);
|
|
|
+ twai_hal_start(&p_twai_obj->hal, p_twai_obj->mode);
|
|
|
|
|
|
p_twai_obj->state = TWAI_STATE_RUNNING;
|
|
|
- TWAI_EXIT_CRITICAL();
|
|
|
+ portEXIT_CRITICAL(&handle->spinlock);
|
|
|
return ESP_OK;
|
|
|
}
|
|
|
|
|
|
-esp_err_t twai_stop(void)
|
|
|
+esp_err_t twai_start(void)
|
|
|
{
|
|
|
+ // the handle-less driver API only support one TWAI controller, i.e. the g_twai_objs[0]
|
|
|
+ return twai_start_v2(g_twai_objs[0]);
|
|
|
+}
|
|
|
+
|
|
|
+esp_err_t twai_stop_v2(twai_handle_t handle)
|
|
|
+{
|
|
|
+ TWAI_CHECK(handle != NULL, ESP_ERR_INVALID_ARG);
|
|
|
+ twai_obj_t *p_twai_obj = handle;
|
|
|
+
|
|
|
+ portENTER_CRITICAL(&handle->spinlock);
|
|
|
//Check state
|
|
|
- TWAI_ENTER_CRITICAL();
|
|
|
- TWAI_CHECK_FROM_CRIT(p_twai_obj != NULL, ESP_ERR_INVALID_STATE);
|
|
|
- TWAI_CHECK_FROM_CRIT(p_twai_obj->state == TWAI_STATE_RUNNING, ESP_ERR_INVALID_STATE);
|
|
|
+ if (p_twai_obj->state != TWAI_STATE_RUNNING) {
|
|
|
+ portEXIT_CRITICAL(&handle->spinlock);
|
|
|
+ return ESP_ERR_INVALID_STATE;
|
|
|
+ }
|
|
|
|
|
|
- twai_hal_stop(&twai_context);
|
|
|
+ twai_hal_stop(&p_twai_obj->hal);
|
|
|
|
|
|
//Reset TX Queue and message count
|
|
|
if (p_twai_obj->tx_queue != NULL) {
|
|
|
@@ -561,22 +590,34 @@ esp_err_t twai_stop(void)
|
|
|
p_twai_obj->tx_msg_count = 0;
|
|
|
p_twai_obj->state = TWAI_STATE_STOPPED;
|
|
|
|
|
|
- TWAI_EXIT_CRITICAL();
|
|
|
-
|
|
|
+ portEXIT_CRITICAL(&handle->spinlock);
|
|
|
return ESP_OK;
|
|
|
}
|
|
|
|
|
|
-esp_err_t twai_transmit(const twai_message_t *message, TickType_t ticks_to_wait)
|
|
|
+esp_err_t twai_stop(void)
|
|
|
+{
|
|
|
+ // the handle-less driver API only support one TWAI controller, i.e. the g_twai_objs[0]
|
|
|
+ return twai_stop_v2(g_twai_objs[0]);
|
|
|
+}
|
|
|
+
|
|
|
+esp_err_t twai_transmit_v2(twai_handle_t handle, const twai_message_t *message, TickType_t ticks_to_wait)
|
|
|
{
|
|
|
//Check arguments
|
|
|
- TWAI_CHECK(p_twai_obj != NULL, ESP_ERR_INVALID_STATE);
|
|
|
+ TWAI_CHECK(handle != NULL, ESP_ERR_INVALID_ARG);
|
|
|
TWAI_CHECK(message != NULL, ESP_ERR_INVALID_ARG);
|
|
|
TWAI_CHECK((message->data_length_code <= TWAI_FRAME_MAX_DLC) || message->dlc_non_comp, ESP_ERR_INVALID_ARG);
|
|
|
|
|
|
- TWAI_ENTER_CRITICAL();
|
|
|
+ twai_obj_t *p_twai_obj = handle;
|
|
|
+ portENTER_CRITICAL(&handle->spinlock);
|
|
|
//Check State
|
|
|
- TWAI_CHECK_FROM_CRIT(!(p_twai_obj->mode == TWAI_MODE_LISTEN_ONLY), ESP_ERR_NOT_SUPPORTED);
|
|
|
- TWAI_CHECK_FROM_CRIT(p_twai_obj->state == TWAI_STATE_RUNNING, ESP_ERR_INVALID_STATE);
|
|
|
+ if (p_twai_obj->mode == TWAI_MODE_LISTEN_ONLY) {
|
|
|
+ portEXIT_CRITICAL(&handle->spinlock);
|
|
|
+ return ESP_ERR_NOT_SUPPORTED;
|
|
|
+ }
|
|
|
+ if (p_twai_obj->state != TWAI_STATE_RUNNING) {
|
|
|
+ portEXIT_CRITICAL(&handle->spinlock);
|
|
|
+ return ESP_ERR_INVALID_STATE;
|
|
|
+ }
|
|
|
//Format frame
|
|
|
esp_err_t ret = ESP_FAIL;
|
|
|
twai_hal_frame_t tx_frame;
|
|
|
@@ -585,11 +626,11 @@ esp_err_t twai_transmit(const twai_message_t *message, TickType_t ticks_to_wait)
|
|
|
//Check if frame can be sent immediately
|
|
|
if (p_twai_obj->tx_msg_count == 0) {
|
|
|
//No other frames waiting to transmit. Bypass queue and transmit immediately
|
|
|
- twai_hal_set_tx_buffer_and_transmit(&twai_context, &tx_frame);
|
|
|
+ twai_hal_set_tx_buffer_and_transmit(&p_twai_obj->hal, &tx_frame);
|
|
|
p_twai_obj->tx_msg_count++;
|
|
|
ret = ESP_OK;
|
|
|
}
|
|
|
- TWAI_EXIT_CRITICAL();
|
|
|
+ portEXIT_CRITICAL(&handle->spinlock);
|
|
|
|
|
|
if (ret != ESP_OK) {
|
|
|
if (p_twai_obj->tx_queue == NULL) {
|
|
|
@@ -597,10 +638,10 @@ esp_err_t twai_transmit(const twai_message_t *message, TickType_t ticks_to_wait)
|
|
|
ret = ESP_FAIL;
|
|
|
} else if (xQueueSend(p_twai_obj->tx_queue, &tx_frame, ticks_to_wait) == pdTRUE) {
|
|
|
//Copied to TX Queue
|
|
|
- TWAI_ENTER_CRITICAL();
|
|
|
- if ((!twai_hal_check_state_flags(&twai_context, TWAI_HAL_STATE_FLAG_TX_BUFF_OCCUPIED)) && uxQueueMessagesWaiting(p_twai_obj->tx_queue) > 0) {
|
|
|
+ portENTER_CRITICAL(&handle->spinlock);
|
|
|
+ if ((!twai_hal_check_state_flags(&p_twai_obj->hal, TWAI_HAL_STATE_FLAG_TX_BUFF_OCCUPIED)) && uxQueueMessagesWaiting(p_twai_obj->tx_queue) > 0) {
|
|
|
//If the TX buffer is free but the TX queue is not empty. Check if we need to manually start a transmission
|
|
|
- if (twai_hal_check_state_flags(&twai_context, TWAI_HAL_STATE_FLAG_BUS_OFF) || !twai_hal_check_state_flags(&twai_context, TWAI_HAL_STATE_FLAG_RUNNING)) {
|
|
|
+ if (twai_hal_check_state_flags(&p_twai_obj->hal, TWAI_HAL_STATE_FLAG_BUS_OFF) || !twai_hal_check_state_flags(&p_twai_obj->hal, TWAI_HAL_STATE_FLAG_RUNNING)) {
|
|
|
//TX buffer became free due to bus-off or is no longer running. No need to start a transmission
|
|
|
ret = ESP_ERR_INVALID_STATE;
|
|
|
} else {
|
|
|
@@ -608,7 +649,7 @@ esp_err_t twai_transmit(const twai_message_t *message, TickType_t ticks_to_wait)
|
|
|
int res = xQueueReceive(p_twai_obj->tx_queue, &tx_frame, 0);
|
|
|
assert(res == pdTRUE);
|
|
|
(void)res;
|
|
|
- twai_hal_set_tx_buffer_and_transmit(&twai_context, &tx_frame);
|
|
|
+ twai_hal_set_tx_buffer_and_transmit(&p_twai_obj->hal, &tx_frame);
|
|
|
p_twai_obj->tx_msg_count++;
|
|
|
ret = ESP_OK;
|
|
|
}
|
|
|
@@ -617,7 +658,7 @@ esp_err_t twai_transmit(const twai_message_t *message, TickType_t ticks_to_wait)
|
|
|
p_twai_obj->tx_msg_count++;
|
|
|
ret = ESP_OK;
|
|
|
}
|
|
|
- TWAI_EXIT_CRITICAL();
|
|
|
+ portEXIT_CRITICAL(&handle->spinlock);
|
|
|
} else {
|
|
|
//Timed out waiting for free space on TX queue
|
|
|
ret = ESP_ERR_TIMEOUT;
|
|
|
@@ -626,39 +667,54 @@ esp_err_t twai_transmit(const twai_message_t *message, TickType_t ticks_to_wait)
|
|
|
return ret;
|
|
|
}
|
|
|
|
|
|
-esp_err_t twai_receive(twai_message_t *message, TickType_t ticks_to_wait)
|
|
|
+esp_err_t twai_transmit(const twai_message_t *message, TickType_t ticks_to_wait)
|
|
|
+{
|
|
|
+ // the handle-less driver API only support one TWAI controller, i.e. the g_twai_objs[0]
|
|
|
+ return twai_transmit_v2(g_twai_objs[0], message, ticks_to_wait);
|
|
|
+}
|
|
|
+
|
|
|
+esp_err_t twai_receive_v2(twai_handle_t handle, twai_message_t *message, TickType_t ticks_to_wait)
|
|
|
{
|
|
|
//Check arguments and state
|
|
|
- TWAI_CHECK(p_twai_obj != NULL, ESP_ERR_INVALID_STATE);
|
|
|
+ TWAI_CHECK(handle != NULL, ESP_ERR_INVALID_ARG);
|
|
|
TWAI_CHECK(message != NULL, ESP_ERR_INVALID_ARG);
|
|
|
|
|
|
+ twai_obj_t *p_twai_obj = handle;
|
|
|
//Get frame from RX Queue or RX Buffer
|
|
|
twai_hal_frame_t rx_frame;
|
|
|
if (xQueueReceive(p_twai_obj->rx_queue, &rx_frame, ticks_to_wait) != pdTRUE) {
|
|
|
return ESP_ERR_TIMEOUT;
|
|
|
}
|
|
|
|
|
|
- TWAI_ENTER_CRITICAL();
|
|
|
+ portENTER_CRITICAL(&handle->spinlock);
|
|
|
p_twai_obj->rx_msg_count--;
|
|
|
- TWAI_EXIT_CRITICAL();
|
|
|
+ portEXIT_CRITICAL(&handle->spinlock);
|
|
|
|
|
|
//Decode frame
|
|
|
twai_hal_parse_frame(&rx_frame, message);
|
|
|
return ESP_OK;
|
|
|
}
|
|
|
|
|
|
-esp_err_t twai_read_alerts(uint32_t *alerts, TickType_t ticks_to_wait)
|
|
|
+esp_err_t twai_receive(twai_message_t *message, TickType_t ticks_to_wait)
|
|
|
+{
|
|
|
+ // the handle-less driver API only support one TWAI controller, i.e. the g_twai_objs[0]
|
|
|
+ return twai_receive_v2(g_twai_objs[0], message, ticks_to_wait);
|
|
|
+}
|
|
|
+
|
|
|
+esp_err_t twai_read_alerts_v2(twai_handle_t handle, uint32_t *alerts, TickType_t ticks_to_wait)
|
|
|
{
|
|
|
//Check arguments and state
|
|
|
- TWAI_CHECK(p_twai_obj != NULL, ESP_ERR_INVALID_STATE);
|
|
|
+ TWAI_CHECK(handle != NULL, ESP_ERR_INVALID_ARG);
|
|
|
TWAI_CHECK(alerts != NULL, ESP_ERR_INVALID_ARG);
|
|
|
|
|
|
+ twai_obj_t *p_twai_obj = handle;
|
|
|
+
|
|
|
//Wait for an alert to occur
|
|
|
if (xSemaphoreTake(p_twai_obj->alert_semphr, ticks_to_wait) == pdTRUE) {
|
|
|
- TWAI_ENTER_CRITICAL();
|
|
|
+ portENTER_CRITICAL(&handle->spinlock);
|
|
|
*alerts = p_twai_obj->alerts_triggered;
|
|
|
p_twai_obj->alerts_triggered = 0; //Clear triggered alerts
|
|
|
- TWAI_EXIT_CRITICAL();
|
|
|
+ portEXIT_CRITICAL(&handle->spinlock);
|
|
|
return ESP_OK;
|
|
|
} else {
|
|
|
*alerts = 0;
|
|
|
@@ -666,28 +722,47 @@ esp_err_t twai_read_alerts(uint32_t *alerts, TickType_t ticks_to_wait)
|
|
|
}
|
|
|
}
|
|
|
|
|
|
-esp_err_t twai_reconfigure_alerts(uint32_t alerts_enabled, uint32_t *current_alerts)
|
|
|
+esp_err_t twai_read_alerts(uint32_t *alerts, TickType_t ticks_to_wait)
|
|
|
+{
|
|
|
+ // the handle-less driver API only support one TWAI controller, i.e. the g_twai_objs[0]
|
|
|
+ return twai_read_alerts_v2(g_twai_objs[0], alerts, ticks_to_wait);
|
|
|
+}
|
|
|
+
|
|
|
+esp_err_t twai_reconfigure_alerts_v2(twai_handle_t handle, uint32_t alerts_enabled, uint32_t *current_alerts)
|
|
|
{
|
|
|
- TWAI_CHECK(p_twai_obj != NULL, ESP_ERR_INVALID_STATE);
|
|
|
+ TWAI_CHECK(handle != NULL, ESP_ERR_INVALID_ARG);
|
|
|
+
|
|
|
+ twai_obj_t *p_twai_obj = handle;
|
|
|
|
|
|
- TWAI_ENTER_CRITICAL();
|
|
|
+ portENTER_CRITICAL(&handle->spinlock);
|
|
|
//Clear any unhandled alerts
|
|
|
if (current_alerts != NULL) {
|
|
|
*current_alerts = p_twai_obj->alerts_triggered;
|
|
|
}
|
|
|
p_twai_obj->alerts_triggered = 0;
|
|
|
p_twai_obj->alerts_enabled = alerts_enabled; //Update enabled alerts
|
|
|
- TWAI_EXIT_CRITICAL();
|
|
|
+ portEXIT_CRITICAL(&handle->spinlock);
|
|
|
|
|
|
return ESP_OK;
|
|
|
}
|
|
|
|
|
|
-esp_err_t twai_initiate_recovery(void)
|
|
|
+esp_err_t twai_reconfigure_alerts(uint32_t alerts_enabled, uint32_t *current_alerts)
|
|
|
+{
|
|
|
+ // the handle-less driver API only support one TWAI controller, i.e. the g_twai_objs[0]
|
|
|
+ return twai_reconfigure_alerts_v2(g_twai_objs[0], alerts_enabled, current_alerts);
|
|
|
+}
|
|
|
+
|
|
|
+esp_err_t twai_initiate_recovery_v2(twai_handle_t handle)
|
|
|
{
|
|
|
- TWAI_ENTER_CRITICAL();
|
|
|
+ TWAI_CHECK(handle != NULL, ESP_ERR_INVALID_ARG);
|
|
|
+ twai_obj_t *p_twai_obj = handle;
|
|
|
+
|
|
|
+ portENTER_CRITICAL(&handle->spinlock);
|
|
|
//Check state
|
|
|
- TWAI_CHECK_FROM_CRIT(p_twai_obj != NULL, ESP_ERR_INVALID_STATE);
|
|
|
- TWAI_CHECK_FROM_CRIT(p_twai_obj->state == TWAI_STATE_BUS_OFF, ESP_ERR_INVALID_STATE);
|
|
|
+ if (p_twai_obj->state != TWAI_STATE_BUS_OFF) {
|
|
|
+ portEXIT_CRITICAL(&handle->spinlock);
|
|
|
+ return ESP_ERR_INVALID_STATE;
|
|
|
+ }
|
|
|
|
|
|
//Reset TX Queue/Counters
|
|
|
if (p_twai_obj->tx_queue != NULL) {
|
|
|
@@ -696,27 +771,34 @@ esp_err_t twai_initiate_recovery(void)
|
|
|
p_twai_obj->tx_msg_count = 0;
|
|
|
|
|
|
//Trigger start of recovery process
|
|
|
- twai_hal_start_bus_recovery(&twai_context);
|
|
|
+ twai_hal_start_bus_recovery(&p_twai_obj->hal);
|
|
|
p_twai_obj->state = TWAI_STATE_RECOVERING;
|
|
|
- TWAI_EXIT_CRITICAL();
|
|
|
+ portEXIT_CRITICAL(&handle->spinlock);
|
|
|
|
|
|
return ESP_OK;
|
|
|
}
|
|
|
|
|
|
-esp_err_t twai_get_status_info(twai_status_info_t *status_info)
|
|
|
+esp_err_t twai_initiate_recovery(void)
|
|
|
+{
|
|
|
+ // the handle-less driver API only support one TWAI controller, i.e. the g_twai_objs[0]
|
|
|
+ return twai_initiate_recovery_v2(g_twai_objs[0]);
|
|
|
+}
|
|
|
+
|
|
|
+esp_err_t twai_get_status_info_v2(twai_handle_t handle, twai_status_info_t *status_info)
|
|
|
{
|
|
|
- //Check parameters and state
|
|
|
- TWAI_CHECK(p_twai_obj != NULL, ESP_ERR_INVALID_STATE);
|
|
|
+ //Check parameters
|
|
|
+ TWAI_CHECK(handle != NULL, ESP_ERR_INVALID_ARG);
|
|
|
TWAI_CHECK(status_info != NULL, ESP_ERR_INVALID_ARG);
|
|
|
+ twai_obj_t *p_twai_obj = handle;
|
|
|
|
|
|
- TWAI_ENTER_CRITICAL();
|
|
|
+ portENTER_CRITICAL(&handle->spinlock);
|
|
|
if (p_twai_obj->mode == TWAI_MODE_LISTEN_ONLY) {
|
|
|
//Error counters are frozen under listen only mode thus are meaningless. Simply return 0 in this case.
|
|
|
status_info->tx_error_counter = 0;
|
|
|
status_info->rx_error_counter = 0;
|
|
|
} else {
|
|
|
- status_info->tx_error_counter = twai_hal_get_tec(&twai_context);
|
|
|
- status_info->rx_error_counter = twai_hal_get_rec(&twai_context);
|
|
|
+ status_info->tx_error_counter = twai_hal_get_tec(&p_twai_obj->hal);
|
|
|
+ status_info->rx_error_counter = twai_hal_get_rec(&p_twai_obj->hal);
|
|
|
}
|
|
|
status_info->msgs_to_tx = p_twai_obj->tx_msg_count;
|
|
|
status_info->msgs_to_rx = p_twai_obj->rx_msg_count;
|
|
|
@@ -726,35 +808,55 @@ esp_err_t twai_get_status_info(twai_status_info_t *status_info)
|
|
|
status_info->arb_lost_count = p_twai_obj->arb_lost_count;
|
|
|
status_info->bus_error_count = p_twai_obj->bus_error_count;
|
|
|
status_info->state = p_twai_obj->state;
|
|
|
- TWAI_EXIT_CRITICAL();
|
|
|
+ portEXIT_CRITICAL(&handle->spinlock);
|
|
|
|
|
|
return ESP_OK;
|
|
|
}
|
|
|
|
|
|
-esp_err_t twai_clear_transmit_queue(void)
|
|
|
+esp_err_t twai_get_status_info(twai_status_info_t *status_info)
|
|
|
{
|
|
|
- //Check State
|
|
|
- TWAI_CHECK(p_twai_obj != NULL, ESP_ERR_INVALID_STATE);
|
|
|
- TWAI_CHECK(p_twai_obj->tx_queue != NULL, ESP_ERR_NOT_SUPPORTED);
|
|
|
+ // the handle-less driver API only support one TWAI controller, i.e. the g_twai_objs[0]
|
|
|
+ return twai_get_status_info_v2(g_twai_objs[0], status_info);
|
|
|
+}
|
|
|
|
|
|
- TWAI_ENTER_CRITICAL();
|
|
|
+esp_err_t twai_clear_transmit_queue_v2(twai_handle_t handle)
|
|
|
+{
|
|
|
+ //Check parameters
|
|
|
+ TWAI_CHECK(handle != NULL, ESP_ERR_INVALID_ARG);
|
|
|
+ TWAI_CHECK(handle->tx_queue != NULL, ESP_ERR_NOT_SUPPORTED);
|
|
|
+ twai_obj_t *p_twai_obj = handle;
|
|
|
+
|
|
|
+ portENTER_CRITICAL(&handle->spinlock);
|
|
|
//If a message is currently undergoing transmission, the tx interrupt handler will decrement tx_msg_count
|
|
|
- p_twai_obj->tx_msg_count = twai_hal_check_state_flags(&twai_context, TWAI_HAL_STATE_FLAG_TX_BUFF_OCCUPIED) ? 1 : 0;
|
|
|
+ p_twai_obj->tx_msg_count = twai_hal_check_state_flags(&p_twai_obj->hal, TWAI_HAL_STATE_FLAG_TX_BUFF_OCCUPIED) ? 1 : 0;
|
|
|
xQueueReset(p_twai_obj->tx_queue);
|
|
|
- TWAI_EXIT_CRITICAL();
|
|
|
+ portEXIT_CRITICAL(&handle->spinlock);
|
|
|
|
|
|
return ESP_OK;
|
|
|
}
|
|
|
|
|
|
-esp_err_t twai_clear_receive_queue(void)
|
|
|
+esp_err_t twai_clear_transmit_queue(void)
|
|
|
{
|
|
|
- //Check State
|
|
|
- TWAI_CHECK(p_twai_obj != NULL, ESP_ERR_INVALID_STATE);
|
|
|
+ // the handle-less driver API only support one TWAI controller, i.e. the g_twai_objs[0]
|
|
|
+ return twai_clear_transmit_queue_v2(g_twai_objs[0]);
|
|
|
+}
|
|
|
|
|
|
- TWAI_ENTER_CRITICAL();
|
|
|
+esp_err_t twai_clear_receive_queue_v2(twai_handle_t handle)
|
|
|
+{
|
|
|
+ //Check parameters
|
|
|
+ TWAI_CHECK(handle != NULL, ESP_ERR_INVALID_ARG);
|
|
|
+ twai_obj_t *p_twai_obj = handle;
|
|
|
+
|
|
|
+ portENTER_CRITICAL(&handle->spinlock);
|
|
|
p_twai_obj->rx_msg_count = 0;
|
|
|
xQueueReset(p_twai_obj->rx_queue);
|
|
|
- TWAI_EXIT_CRITICAL();
|
|
|
+ portEXIT_CRITICAL(&handle->spinlock);
|
|
|
|
|
|
return ESP_OK;
|
|
|
}
|
|
|
+
|
|
|
+esp_err_t twai_clear_receive_queue(void)
|
|
|
+{
|
|
|
+ // the handle-less driver API only support one TWAI controller, i.e. the g_twai_objs[0]
|
|
|
+ return twai_clear_receive_queue_v2(g_twai_objs[0]);
|
|
|
+}
|