| 1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216 |
- /*
- * Copyright (c) 2006-2025, RT-Thread Development Team
- *
- * SPDX-License-Identifier: Apache-2.0
- *
- * Change Logs:
- * Date Author Notes
- * 2015-05-14 aubrcool@qq.com first version
- * 2015-07-06 Bernard code cleanup and remove RT_CAN_USING_LED;
- * 2025-09-20 wdfk_prog Implemented non-blocking, ISR-safe send logic unified under rt_device_write.
- */
- #include <rthw.h>
- #include <rtthread.h>
- #include <rtdevice.h>
- #define CAN_LOCK(can) rt_mutex_take(&(can->lock), RT_WAITING_FOREVER)
- #define CAN_UNLOCK(can) rt_mutex_release(&(can->lock))
- static rt_err_t rt_can_init(struct rt_device *dev)
- {
- rt_err_t result = RT_EOK;
- struct rt_can_device *can;
- RT_ASSERT(dev != RT_NULL);
- can = (struct rt_can_device *)dev;
- /* initialize rx/tx */
- can->can_rx = RT_NULL;
- can->can_tx = RT_NULL;
- #ifdef RT_CAN_USING_HDR
- can->hdr = RT_NULL;
- #endif
- /* apply configuration */
- if (can->ops->configure)
- result = can->ops->configure(can, &can->config);
- else
- result = -RT_ENOSYS;
- return result;
- }
- /**
- * @internal
- * @brief Handles reading messages from the software RX FIFO into a user buffer.
- *
- * This function is called by the public `rt_can_read()` API when the device
- * is opened with interrupt-driven reception enabled. It safely transfers
- * messages from the internal `uselist` to the user-provided buffer.
- *
- * @param[in] can A pointer to the CAN device.
- * @param[out] data A pointer to the destination buffer for the received messages.
- * @param[in] msgs The total size in bytes of the destination buffer.
- *
- * @return The number of bytes actually read from the FIFO.
- */
- rt_inline rt_ssize_t _can_int_rx(struct rt_can_device *can, struct rt_can_msg *data, rt_ssize_t msgs)
- {
- rt_ssize_t size;
- struct rt_can_rx_fifo *rx_fifo;
- RT_ASSERT(can != RT_NULL);
- size = msgs;
- rx_fifo = (struct rt_can_rx_fifo *) can->can_rx;
- RT_ASSERT(rx_fifo != RT_NULL);
- /* read from software FIFO */
- while (msgs / sizeof(struct rt_can_msg) > 0)
- {
- rt_base_t level;
- #ifdef RT_CAN_USING_HDR
- rt_int8_t hdr;
- #endif /*RT_CAN_USING_HDR*/
- struct rt_can_msg_list *listmsg = RT_NULL;
- /* disable interrupt */
- level = rt_hw_local_irq_disable();
- #ifdef RT_CAN_USING_HDR
- hdr = data->hdr_index;
- if (hdr >= 0 && can->hdr && hdr < can->config.maxhdr && !rt_list_isempty(&can->hdr[hdr].list))
- {
- listmsg = rt_list_entry(can->hdr[hdr].list.next, struct rt_can_msg_list, hdrlist);
- rt_list_remove(&listmsg->list);
- rt_list_remove(&listmsg->hdrlist);
- if (can->hdr[hdr].msgs)
- {
- can->hdr[hdr].msgs--;
- }
- listmsg->owner = RT_NULL;
- }
- else if (hdr == -1)
- #endif /*RT_CAN_USING_HDR*/
- {
- if (!rt_list_isempty(&rx_fifo->uselist))
- {
- listmsg = rt_list_entry(rx_fifo->uselist.next, struct rt_can_msg_list, list);
- rt_list_remove(&listmsg->list);
- #ifdef RT_CAN_USING_HDR
- rt_list_remove(&listmsg->hdrlist);
- if (listmsg->owner != RT_NULL && listmsg->owner->msgs)
- {
- listmsg->owner->msgs--;
- }
- listmsg->owner = RT_NULL;
- #endif /*RT_CAN_USING_HDR*/
- }
- else
- {
- /* no data, enable interrupt and break out */
- rt_hw_local_irq_enable(level);
- break;
- }
- }
- /* enable interrupt */
- rt_hw_local_irq_enable(level);
- if (listmsg != RT_NULL)
- {
- rt_memcpy(data, &listmsg->data, sizeof(struct rt_can_msg));
- level = rt_hw_local_irq_disable();
- rt_list_insert_before(&rx_fifo->freelist, &listmsg->list);
- rx_fifo->freenumbers++;
- RT_ASSERT(rx_fifo->freenumbers <= can->config.msgboxsz);
- rt_hw_local_irq_enable(level);
- listmsg = RT_NULL;
- }
- else
- {
- break;
- }
- data ++;
- msgs -= sizeof(struct rt_can_msg);
- }
- return (size - msgs);
- }
- /**
- * @internal
- * @brief Handles the blocking (synchronous) transmission of CAN messages.
- *
- * This function is the core of the blocking send mechanism. It iterates through
- * a buffer of messages to be sent. For each message, it:
- * 1. Acquires a hardware mailbox resource using a semaphore.
- * 2. Submits the message to the low-level driver for transmission.
- * 3. Blocks the calling thread by waiting on a completion object.
- * 4. Is woken up by the TX complete ISR (`rt_hw_can_isr`) when the transmission is finished.
- *
- * @note This function will block the calling thread and must not be called from an ISR.
- *
- * @param[in] can A pointer to the CAN device.
- * @param[in] data A pointer to the source buffer of messages to be sent.
- * @param[in] msgs The total size in bytes of the source buffer.
- *
- * @return The number of bytes successfully sent.
- */
- rt_inline int _can_int_tx(struct rt_can_device *can, const struct rt_can_msg *data, int msgs)
- {
- int size;
- struct rt_can_tx_fifo *tx_fifo;
- RT_ASSERT(can != RT_NULL);
- size = msgs;
- tx_fifo = (struct rt_can_tx_fifo *) can->can_tx;
- RT_ASSERT(tx_fifo != RT_NULL);
- while (msgs)
- {
- rt_base_t level;
- rt_uint32_t no;
- rt_uint32_t result;
- struct rt_can_sndbxinx_list *tx_tosnd = RT_NULL;
- rt_sem_take(&(tx_fifo->sem), RT_WAITING_FOREVER);
- level = rt_hw_local_irq_disable();
- tx_tosnd = rt_list_entry(tx_fifo->freelist.next, struct rt_can_sndbxinx_list, list);
- RT_ASSERT(tx_tosnd != RT_NULL);
- rt_list_remove(&tx_tosnd->list);
- rt_hw_local_irq_enable(level);
- no = ((rt_ubase_t)tx_tosnd - (rt_ubase_t)tx_fifo->buffer) / sizeof(struct rt_can_sndbxinx_list);
- tx_tosnd->result = RT_CAN_SND_RESULT_WAIT;
- rt_completion_init(&tx_tosnd->completion);
- if (can->ops->sendmsg(can, data, no) != RT_EOK)
- {
- /* send failed. */
- level = rt_hw_local_irq_disable();
- rt_list_insert_before(&tx_fifo->freelist, &tx_tosnd->list);
- rt_hw_local_irq_enable(level);
- rt_sem_release(&(tx_fifo->sem));
- goto err_ret;
- }
- can->status.sndchange |= 1<<no;
- if (rt_completion_wait(&(tx_tosnd->completion), RT_CANSND_MSG_TIMEOUT) != RT_EOK)
- {
- level = rt_hw_local_irq_disable();
- rt_list_insert_before(&tx_fifo->freelist, &tx_tosnd->list);
- can->status.sndchange &= ~ (1<<no);
- rt_hw_local_irq_enable(level);
- rt_sem_release(&(tx_fifo->sem));
- goto err_ret;
- }
- level = rt_hw_local_irq_disable();
- result = tx_tosnd->result;
- if (!rt_list_isempty(&tx_tosnd->list))
- {
- rt_list_remove(&tx_tosnd->list);
- }
- rt_list_insert_before(&tx_fifo->freelist, &tx_tosnd->list);
- rt_hw_local_irq_enable(level);
- rt_sem_release(&(tx_fifo->sem));
- if (result == RT_CAN_SND_RESULT_OK)
- {
- level = rt_hw_local_irq_disable();
- can->status.sndpkg++;
- rt_hw_local_irq_enable(level);
- data ++;
- msgs -= sizeof(struct rt_can_msg);
- if (!msgs) break;
- }
- else
- {
- err_ret:
- level = rt_hw_local_irq_disable();
- can->status.dropedsndpkg++;
- rt_hw_local_irq_enable(level);
- break;
- }
- }
- return (size - msgs);
- }
- /**
- * @internal
- * @brief Handles blocking transmission in "private mode".
- *
- * This is a specialized version of `_can_int_tx` where the target hardware mailbox
- * for each message is specified by the user in the `priv` field of the `rt_can_msg`
- * structure, rather than being acquired dynamically from a pool.
- *
- * @param[in] can A pointer to the CAN device.
- * @param[in] data A pointer to the source buffer of messages.
- * @param[in] msgs The total size in bytes of the source buffer.
- *
- * @return The number of bytes successfully sent.
- */
- rt_inline int _can_int_tx_priv(struct rt_can_device *can, const struct rt_can_msg *data, int msgs)
- {
- int size;
- rt_base_t level;
- rt_uint32_t no, result;
- struct rt_can_tx_fifo *tx_fifo;
- RT_ASSERT(can != RT_NULL);
- size = msgs;
- tx_fifo = (struct rt_can_tx_fifo *) can->can_tx;
- RT_ASSERT(tx_fifo != RT_NULL);
- while (msgs)
- {
- no = data->priv;
- if (no >= can->config.sndboxnumber)
- {
- break;
- }
- level = rt_hw_local_irq_disable();
- if ((tx_fifo->buffer[no].result != RT_CAN_SND_RESULT_OK))
- {
- rt_hw_local_irq_enable(level);
- rt_completion_wait(&(tx_fifo->buffer[no].completion), RT_WAITING_FOREVER);
- continue;
- }
- tx_fifo->buffer[no].result = RT_CAN_SND_RESULT_WAIT;
- rt_hw_local_irq_enable(level);
- if (can->ops->sendmsg(can, data, no) != RT_EOK)
- {
- continue;
- }
- can->status.sndchange |= 1<<no;
- if (rt_completion_wait(&(tx_fifo->buffer[no].completion), RT_CANSND_MSG_TIMEOUT) != RT_EOK)
- {
- can->status.sndchange &= ~ (1<<no);
- continue;
- }
- result = tx_fifo->buffer[no].result;
- if (result == RT_CAN_SND_RESULT_OK)
- {
- level = rt_hw_local_irq_disable();
- can->status.sndpkg++;
- rt_hw_local_irq_enable(level);
- data ++;
- msgs -= sizeof(struct rt_can_msg);
- if (!msgs) break;
- }
- else
- {
- level = rt_hw_local_irq_disable();
- can->status.dropedsndpkg++;
- rt_hw_local_irq_enable(level);
- break;
- }
- }
- return (size - msgs);
- }
- /**
- * @internal
- * @brief Internal implementation of non-blocking CAN transmission.
- *
- * This function iterates through a buffer of CAN messages and attempts to send each one
- * using a non-blocking strategy. It first tries to send directly via hardware (fast path).
- * If the hardware is busy, it enqueues the message into a software ring buffer (slow path).
- * This function is thread-safe and ISR-safe due to the use of critical sections for
- * accessing the shared ring buffer.
- *
- * @param[in] can A pointer to the CAN device.
- * @param[in] pmsg A pointer to the buffer of `rt_can_msg` structures.
- * @param[in] size The total size of the buffer in bytes.
- *
- * @return The number of bytes successfully sent or enqueued for later transmission.
- */
- static rt_ssize_t _can_nonblocking_tx(struct rt_can_device *can, const struct rt_can_msg *pmsg, rt_size_t size)
- {
- rt_ssize_t sent_size = 0;
- rt_base_t level;
- if (can->ops->sendmsg_nonblocking == RT_NULL)
- {
- return -RT_EINVAL;
- }
- while (sent_size < size)
- {
- if (can->ops->sendmsg_nonblocking(can, pmsg) == RT_EOK)
- {
- pmsg++;
- sent_size += sizeof(struct rt_can_msg);
- continue;
- }
- level = rt_hw_local_irq_disable();
- if (rt_ringbuffer_space_len(&can->nb_tx_rb) >= sizeof(struct rt_can_msg))
- {
- rt_ringbuffer_put(&can->nb_tx_rb, (rt_uint8_t *)pmsg, sizeof(struct rt_can_msg));
- rt_hw_local_irq_enable(level);
- pmsg++;
- sent_size += sizeof(struct rt_can_msg);
- }
- else
- {
- /* Buffer is full, cannot process this message or subsequent ones. */
- can->status.dropedsndpkg += (size - sent_size) / sizeof(struct rt_can_msg);
- rt_hw_local_irq_enable(level);
- break;
- }
- }
- return sent_size;
- }
- /**
- * @internal
- * @brief Opens the CAN device and initializes its resources.
- *
- * This function is called when `rt_device_open()` is invoked on a CAN device.
- * It allocates and initializes software FIFOs for reception and transmission,
- * sets up semaphores for the blocking send mechanism, configures the non-blocking
- * send buffer, and starts the periodic status timer.
- *
- * @param[in] dev A pointer to the device to be opened.
- * @param[in] oflag The open flags, e.g., `RT_DEVICE_FLAG_INT_RX | RT_DEVICE_FLAG_INT_TX`.
- *
- * @return `RT_EOK` on successful opening, or an error code on failure.
- */
- static rt_err_t rt_can_open(struct rt_device *dev, rt_uint16_t oflag)
- {
- struct rt_can_device *can;
- char tmpname[16];
- RT_ASSERT(dev != RT_NULL);
- can = (struct rt_can_device *)dev;
- CAN_LOCK(can);
- /* get open flags */
- dev->open_flag = oflag & 0xff;
- if (can->can_rx == RT_NULL)
- {
- if (oflag & RT_DEVICE_FLAG_INT_RX)
- {
- int i = 0;
- struct rt_can_rx_fifo *rx_fifo;
- rx_fifo = (struct rt_can_rx_fifo *) rt_malloc(sizeof(struct rt_can_rx_fifo) +
- can->config.msgboxsz * sizeof(struct rt_can_msg_list));
- RT_ASSERT(rx_fifo != RT_NULL);
- rx_fifo->buffer = (struct rt_can_msg_list *)(rx_fifo + 1);
- rt_memset(rx_fifo->buffer, 0, can->config.msgboxsz * sizeof(struct rt_can_msg_list));
- rt_list_init(&rx_fifo->freelist);
- rt_list_init(&rx_fifo->uselist);
- rx_fifo->freenumbers = can->config.msgboxsz;
- for (i = 0; i < can->config.msgboxsz; i++)
- {
- rt_list_insert_before(&rx_fifo->freelist, &rx_fifo->buffer[i].list);
- #ifdef RT_CAN_USING_HDR
- rt_list_init(&rx_fifo->buffer[i].hdrlist);
- rx_fifo->buffer[i].owner = RT_NULL;
- #endif
- }
- can->can_rx = rx_fifo;
- dev->open_flag |= RT_DEVICE_FLAG_INT_RX;
- /* open can rx interrupt */
- can->ops->control(can, RT_DEVICE_CTRL_SET_INT, (void *)RT_DEVICE_FLAG_INT_RX);
- }
- }
- if (can->can_tx == RT_NULL)
- {
- if (oflag & RT_DEVICE_FLAG_INT_TX)
- {
- int i = 0;
- struct rt_can_tx_fifo *tx_fifo;
- tx_fifo = (struct rt_can_tx_fifo *) rt_malloc(sizeof(struct rt_can_tx_fifo) +
- can->config.sndboxnumber * sizeof(struct rt_can_sndbxinx_list));
- RT_ASSERT(tx_fifo != RT_NULL);
- tx_fifo->buffer = (struct rt_can_sndbxinx_list *)(tx_fifo + 1);
- rt_memset(tx_fifo->buffer, 0,
- can->config.sndboxnumber * sizeof(struct rt_can_sndbxinx_list));
- rt_list_init(&tx_fifo->freelist);
- for (i = 0; i < can->config.sndboxnumber; i++)
- {
- rt_list_insert_before(&tx_fifo->freelist, &tx_fifo->buffer[i].list);
- rt_completion_init(&(tx_fifo->buffer[i].completion));
- tx_fifo->buffer[i].result = RT_CAN_SND_RESULT_OK;
- }
- rt_sprintf(tmpname, "%stl", dev->parent.name);
- rt_sem_init(&(tx_fifo->sem), tmpname, can->config.sndboxnumber, RT_IPC_FLAG_FIFO);
- can->can_tx = tx_fifo;
- dev->open_flag |= RT_DEVICE_FLAG_INT_TX;
- /* open can tx interrupt */
- can->ops->control(can, RT_DEVICE_CTRL_SET_INT, (void *)RT_DEVICE_FLAG_INT_TX);
- }
- }
- can->ops->control(can, RT_DEVICE_CTRL_SET_INT, (void *)RT_DEVICE_CAN_INT_ERR);
- #ifdef RT_CAN_USING_HDR
- if (can->hdr == RT_NULL)
- {
- int i = 0;
- struct rt_can_hdr *phdr;
- phdr = (struct rt_can_hdr *) rt_malloc(can->config.maxhdr * sizeof(struct rt_can_hdr));
- RT_ASSERT(phdr != RT_NULL);
- rt_memset(phdr, 0, can->config.maxhdr * sizeof(struct rt_can_hdr));
- for (i = 0; i < can->config.maxhdr; i++)
- {
- rt_list_init(&phdr[i].list);
- }
- can->hdr = phdr;
- }
- #endif
- #ifdef RT_CAN_MALLOC_NB_TX_BUFFER
- can->nb_tx_rb_pool = (rt_uint8_t *)rt_malloc(RT_CAN_NB_TX_FIFO_SIZE);
- RT_ASSERT(can->nb_tx_rb_pool != RT_NULL);
- #endif /* RT_CAN_MALLOC_NB_TX_BUFFER */
- rt_ringbuffer_init(&can->nb_tx_rb, can->nb_tx_rb_pool, RT_CAN_NB_TX_FIFO_SIZE);
- if (!can->timerinitflag)
- {
- can->timerinitflag = 1;
- rt_timer_start(&can->timer);
- }
- CAN_UNLOCK(can);
- return RT_EOK;
- }
- static rt_err_t rt_can_close(struct rt_device *dev)
- {
- struct rt_can_device *can;
- RT_ASSERT(dev != RT_NULL);
- can = (struct rt_can_device *)dev;
- CAN_LOCK(can);
- /* this device has more reference count */
- if (dev->ref_count > 1)
- {
- CAN_UNLOCK(can);
- return RT_EOK;
- }
- #ifdef RT_CAN_MALLOC_NB_TX_BUFFER
- if (can->nb_tx_rb_pool)
- {
- rt_free(can->nb_tx_rb_pool);
- can->nb_tx_rb_pool = RT_NULL;
- }
- #endif
- if (can->timerinitflag)
- {
- can->timerinitflag = 0;
- rt_timer_stop(&can->timer);
- }
- can->status_indicate.ind = RT_NULL;
- can->status_indicate.args = RT_NULL;
- #ifdef RT_CAN_USING_HDR
- if (can->hdr != RT_NULL)
- {
- rt_free(can->hdr);
- can->hdr = RT_NULL;
- }
- #endif
- if (dev->open_flag & RT_DEVICE_FLAG_INT_RX)
- {
- struct rt_can_rx_fifo *rx_fifo;
- /* clear can rx interrupt */
- can->ops->control(can, RT_DEVICE_CTRL_CLR_INT, (void *)RT_DEVICE_FLAG_INT_RX);
- rx_fifo = (struct rt_can_rx_fifo *)can->can_rx;
- RT_ASSERT(rx_fifo != RT_NULL);
- rt_free(rx_fifo);
- dev->open_flag &= ~RT_DEVICE_FLAG_INT_RX;
- can->can_rx = RT_NULL;
- }
- if (dev->open_flag & RT_DEVICE_FLAG_INT_TX)
- {
- struct rt_can_tx_fifo *tx_fifo;
- /* clear can tx interrupt */
- can->ops->control(can, RT_DEVICE_CTRL_CLR_INT, (void *)RT_DEVICE_FLAG_INT_TX);
- tx_fifo = (struct rt_can_tx_fifo *)can->can_tx;
- RT_ASSERT(tx_fifo != RT_NULL);
- rt_sem_detach(&(tx_fifo->sem));
- rt_free(tx_fifo);
- dev->open_flag &= ~RT_DEVICE_FLAG_INT_TX;
- can->can_tx = RT_NULL;
- }
- can->ops->control(can, RT_DEVICE_CTRL_CLR_INT, (void *)RT_DEVICE_CAN_INT_ERR);
- can->ops->control(can, RT_CAN_CMD_START, RT_FALSE);
- CAN_UNLOCK(can);
- return RT_EOK;
- }
- static rt_ssize_t rt_can_read(struct rt_device *dev,
- rt_off_t pos,
- void *buffer,
- rt_size_t size)
- {
- struct rt_can_device *can;
- RT_ASSERT(dev != RT_NULL);
- if (size == 0) return -RT_EINVAL;
- can = (struct rt_can_device *)dev;
- if ((dev->open_flag & RT_DEVICE_FLAG_INT_RX) && (dev->ref_count > 0))
- {
- return _can_int_rx(can, buffer, size);
- }
- return -RT_ENOSYS;
- }
- /**
- * @brief Write data to the CAN device.
- *
- * This function serves as the unified entry point for sending CAN messages.
- * It intelligently routes the request to either a blocking or non-blocking
- * transmission function based on:
- * 1. The calling context (thread or ISR).
- * 2. A user-specified flag (`nonblocking`) in the message structure.
- *
- * @param[in] dev A pointer to the device object.
- * @param[in] pos This parameter is ignored for CAN devices.
- * @param[in] buffer A pointer to the buffer containing one or more `rt_can_msg` structures.
- * @param[in] size The total size of the buffer in bytes. Must be a multiple of `sizeof(struct rt_can_msg)`.
- *
- * @return The number of bytes successfully written. For non-blocking sends, this means
- * the data was either sent directly or enqueued in the buffer.
- */
- static rt_ssize_t rt_can_write(struct rt_device *dev,
- rt_off_t pos,
- const void *buffer,
- rt_size_t size)
- {
- struct rt_can_device *can;
- const struct rt_can_msg *pmsg;
- RT_ASSERT(dev != RT_NULL);
- RT_ASSERT(buffer != RT_NULL);
- if (size == 0) return -RT_EINVAL;
- /* Ensure size is a multiple of the message size for buffer operations */
- if (size % sizeof(struct rt_can_msg) != 0)
- {
- return -RT_EINVAL;
- }
- can = (struct rt_can_device *)dev;
- pmsg = (const struct rt_can_msg *)buffer;
- if(dev->ref_count == 0)
- {
- return -RT_ENOSYS;
- }
- /*
- * Routing to the non-blocking send scenario:
- * 1. Called from within an interrupt context.
- * 2. Called from a thread, but the user explicitly set the nonblocking flag on the first message.
- */
- if (rt_interrupt_get_nest() > 0 || pmsg->nonblocking)
- {
- return _can_nonblocking_tx(can, pmsg, size);
- }
- if (dev->open_flag & RT_DEVICE_FLAG_INT_TX)
- {
- if (can->config.privmode)
- {
- return _can_int_tx_priv(can, buffer, size);
- }
- else
- {
- return _can_int_tx(can, buffer, size);
- }
- }
- return -RT_ENOSYS;
- }
- static rt_err_t rt_can_control(struct rt_device *dev,
- int cmd,
- void *args)
- {
- struct rt_can_device *can;
- rt_err_t res;
- res = RT_EOK;
- RT_ASSERT(dev != RT_NULL);
- can = (struct rt_can_device *)dev;
- switch (cmd)
- {
- case RT_DEVICE_CTRL_SUSPEND:
- /* suspend device */
- dev->flag |= RT_DEVICE_FLAG_SUSPENDED;
- break;
- case RT_DEVICE_CTRL_RESUME:
- /* resume device */
- dev->flag &= ~RT_DEVICE_FLAG_SUSPENDED;
- break;
- case RT_DEVICE_CTRL_CONFIG:
- /* configure device */
- res = can->ops->configure(can, (struct can_configure *)args);
- break;
- case RT_CAN_CMD_SET_PRIV:
- /* configure device */
- if ((rt_uint32_t)(rt_ubase_t)args != can->config.privmode)
- {
- int i;
- rt_base_t level;
- struct rt_can_tx_fifo *tx_fifo;
- res = can->ops->control(can, cmd, args);
- if (res != RT_EOK) return res;
- tx_fifo = (struct rt_can_tx_fifo *) can->can_tx;
- if (can->config.privmode)
- {
- for (i = 0; i < can->config.sndboxnumber; i++)
- {
- level = rt_hw_local_irq_disable();
- if(rt_list_isempty(&tx_fifo->buffer[i].list))
- {
- rt_sem_release(&(tx_fifo->sem));
- }
- else
- {
- rt_list_remove(&tx_fifo->buffer[i].list);
- }
- rt_hw_local_irq_enable(level);
- }
- }
- else
- {
- for (i = 0; i < can->config.sndboxnumber; i++)
- {
- level = rt_hw_local_irq_disable();
- if (tx_fifo->buffer[i].result == RT_CAN_SND_RESULT_OK)
- {
- rt_list_insert_before(&tx_fifo->freelist, &tx_fifo->buffer[i].list);
- }
- rt_hw_local_irq_enable(level);
- }
- }
- }
- break;
- case RT_CAN_CMD_SET_STATUS_IND:
- can->status_indicate.ind = ((rt_can_status_ind_type_t)args)->ind;
- can->status_indicate.args = ((rt_can_status_ind_type_t)args)->args;
- break;
- #ifdef RT_CAN_USING_HDR
- case RT_CAN_CMD_SET_FILTER:
- res = can->ops->control(can, cmd, args);
- if (res != RT_EOK || can->hdr == RT_NULL)
- {
- return res;
- }
- struct rt_can_filter_config *pfilter;
- struct rt_can_filter_item *pitem;
- rt_uint32_t count;
- rt_base_t level;
- pfilter = (struct rt_can_filter_config *)args;
- RT_ASSERT(pfilter);
- count = pfilter->count;
- pitem = pfilter->items;
- if (pfilter->actived)
- {
- while (count)
- {
- if (pitem->hdr_bank >= can->config.maxhdr || pitem->hdr_bank < 0)
- {
- count--;
- pitem++;
- continue;
- }
- level = rt_hw_local_irq_disable();
- if (!can->hdr[pitem->hdr_bank].connected)
- {
- rt_hw_local_irq_enable(level);
- rt_memcpy(&can->hdr[pitem->hdr_bank].filter, pitem,
- sizeof(struct rt_can_filter_item));
- level = rt_hw_local_irq_disable();
- can->hdr[pitem->hdr_bank].connected = 1;
- can->hdr[pitem->hdr_bank].msgs = 0;
- rt_list_init(&can->hdr[pitem->hdr_bank].list);
- }
- rt_hw_local_irq_enable(level);
- count--;
- pitem++;
- }
- }
- else
- {
- while (count)
- {
- if (pitem->hdr_bank >= can->config.maxhdr || pitem->hdr_bank < 0)
- {
- count--;
- pitem++;
- continue;
- }
- level = rt_hw_local_irq_disable();
- if (can->hdr[pitem->hdr_bank].connected)
- {
- can->hdr[pitem->hdr_bank].connected = 0;
- can->hdr[pitem->hdr_bank].msgs = 0;
- if (!rt_list_isempty(&can->hdr[pitem->hdr_bank].list))
- {
- rt_list_remove(can->hdr[pitem->hdr_bank].list.next);
- }
- rt_hw_local_irq_enable(level);
- rt_memset(&can->hdr[pitem->hdr_bank].filter, 0,
- sizeof(struct rt_can_filter_item));
- }
- else
- {
- rt_hw_local_irq_enable(level);
- }
- count--;
- pitem++;
- }
- }
- break;
- #endif /*RT_CAN_USING_HDR*/
- #ifdef RT_CAN_USING_BUS_HOOK
- case RT_CAN_CMD_SET_BUS_HOOK:
- can->bus_hook = (rt_can_bus_hook) args;
- break;
- #endif /*RT_CAN_USING_BUS_HOOK*/
- default :
- /* control device */
- if (can->ops->control != RT_NULL)
- {
- res = can->ops->control(can, cmd, args);
- }
- else
- {
- res = -RT_ENOSYS;
- }
- break;
- }
- return res;
- }
- /**
- * @internal
- * @brief Periodic timer callback for the CAN device.
- *
- * This function is executed periodically by a system timer. Its main purposes are:
- * 1. To query the current status of the CAN controller (e.g., error counters, bus state).
- * 2. To invoke a user-registered status indicator callback, if any.
- * 3. To call a user-registered bus hook function for periodic tasks, if any.
- *
- * @param[in] arg The argument passed to the callback, which is a pointer to the `rt_can_device`.
- * @return void
- */
- static void cantimeout(void *arg)
- {
- rt_can_t can;
- can = (rt_can_t)arg;
- RT_ASSERT(can);
- rt_device_control((rt_device_t)can, RT_CAN_CMD_GET_STATUS, (void *)&can->status);
- if (can->status_indicate.ind != RT_NULL)
- {
- can->status_indicate.ind(can, can->status_indicate.args);
- }
- #ifdef RT_CAN_USING_BUS_HOOK
- if(can->bus_hook)
- {
- can->bus_hook(can);
- }
- #endif /*RT_CAN_USING_BUS_HOOK*/
- if (can->timerinitflag == 1)
- {
- can->timerinitflag = 0xFF;
- }
- }
- #ifdef RT_USING_DEVICE_OPS
- const static struct rt_device_ops can_device_ops =
- {
- rt_can_init,
- rt_can_open,
- rt_can_close,
- rt_can_read,
- rt_can_write,
- rt_can_control
- };
- #endif
- /*
- * can register
- */
- rt_err_t rt_hw_can_register(struct rt_can_device *can,
- const char *name,
- const struct rt_can_ops *ops,
- void *data)
- {
- struct rt_device *device;
- RT_ASSERT(can != RT_NULL);
- device = &(can->parent);
- device->type = RT_Device_Class_CAN;
- device->rx_indicate = RT_NULL;
- device->tx_complete = RT_NULL;
- #ifdef RT_CAN_USING_HDR
- can->hdr = RT_NULL;
- #endif
- can->can_rx = RT_NULL;
- can->can_tx = RT_NULL;
- rt_mutex_init(&(can->lock), "can", RT_IPC_FLAG_PRIO);
- #ifdef RT_CAN_USING_BUS_HOOK
- can->bus_hook = RT_NULL;
- #endif /*RT_CAN_USING_BUS_HOOK*/
- #ifdef RT_CAN_MALLOC_NB_TX_BUFFER
- can->nb_tx_rb_pool = RT_NULL;
- #endif
- #ifdef RT_USING_DEVICE_OPS
- device->ops = &can_device_ops;
- #else
- device->init = rt_can_init;
- device->open = rt_can_open;
- device->close = rt_can_close;
- device->read = rt_can_read;
- device->write = rt_can_write;
- device->control = rt_can_control;
- #endif
- can->ops = ops;
- can->status_indicate.ind = RT_NULL;
- can->status_indicate.args = RT_NULL;
- rt_memset(&can->status, 0, sizeof(can->status));
- device->user_data = data;
- can->timerinitflag = 0;
- rt_timer_init(&can->timer,
- name,
- cantimeout,
- (void *)can,
- can->config.ticks,
- RT_TIMER_FLAG_PERIODIC);
- /* register a character device */
- return rt_device_register(device, name, RT_DEVICE_FLAG_RDWR);
- }
- /* ISR for can interrupt */
- /**
- * @brief The framework-level ISR handler for CAN devices.
- *
- * This function is called by the low-level BSP ISR and acts as the central
- * dispatcher for all CAN-related interrupt events. It handles both receive
- * events and transmission-complete events.
- *
- * @param[in] can A pointer to the CAN device structure.
- * @param[in] event The interrupt event mask, indicating the cause of the interrupt.
- * @return void
- */
- void rt_hw_can_isr(struct rt_can_device *can, int event)
- {
- switch (event & 0xff)
- {
- case RT_CAN_EVENT_RXOF_IND:
- {
- rt_base_t level;
- level = rt_hw_local_irq_disable();
- can->status.dropedrcvpkg++;
- rt_hw_local_irq_enable(level);
- }
- case RT_CAN_EVENT_RX_IND:
- {
- struct rt_can_msg tmpmsg;
- struct rt_can_rx_fifo *rx_fifo;
- struct rt_can_msg_list *listmsg = RT_NULL;
- #ifdef RT_CAN_USING_HDR
- rt_int8_t hdr;
- #endif
- int ch = -1;
- rt_base_t level;
- rt_uint32_t no;
- rx_fifo = (struct rt_can_rx_fifo *)can->can_rx;
- RT_ASSERT(rx_fifo != RT_NULL);
- /* interrupt mode receive */
- RT_ASSERT(can->parent.open_flag & RT_DEVICE_FLAG_INT_RX);
- no = event >> 8;
- ch = can->ops->recvmsg(can, &tmpmsg, no);
- if (ch == -1) break;
- /* disable interrupt */
- level = rt_hw_local_irq_disable();
- can->status.rcvpkg++;
- can->status.rcvchange = 1;
- if (!rt_list_isempty(&rx_fifo->freelist))
- {
- listmsg = rt_list_entry(rx_fifo->freelist.next, struct rt_can_msg_list, list);
- rt_list_remove(&listmsg->list);
- #ifdef RT_CAN_USING_HDR
- rt_list_remove(&listmsg->hdrlist);
- if (listmsg->owner != RT_NULL && listmsg->owner->msgs)
- {
- listmsg->owner->msgs--;
- }
- listmsg->owner = RT_NULL;
- #endif /*RT_CAN_USING_HDR*/
- RT_ASSERT(rx_fifo->freenumbers > 0);
- rx_fifo->freenumbers--;
- }
- else if (!rt_list_isempty(&rx_fifo->uselist))
- {
- listmsg = rt_list_entry(rx_fifo->uselist.next, struct rt_can_msg_list, list);
- can->status.dropedrcvpkg++;
- rt_list_remove(&listmsg->list);
- #ifdef RT_CAN_USING_HDR
- rt_list_remove(&listmsg->hdrlist);
- if (listmsg->owner != RT_NULL && listmsg->owner->msgs)
- {
- listmsg->owner->msgs--;
- }
- listmsg->owner = RT_NULL;
- #endif
- }
- /* enable interrupt */
- rt_hw_local_irq_enable(level);
- if (listmsg != RT_NULL)
- {
- rt_memcpy(&listmsg->data, &tmpmsg, sizeof(struct rt_can_msg));
- level = rt_hw_local_irq_disable();
- rt_list_insert_before(&rx_fifo->uselist, &listmsg->list);
- #ifdef RT_CAN_USING_HDR
- hdr = tmpmsg.hdr_index;
- if (can->hdr != RT_NULL)
- {
- RT_ASSERT(hdr < can->config.maxhdr && hdr >= 0);
- if (can->hdr[hdr].connected)
- {
- rt_list_insert_before(&can->hdr[hdr].list, &listmsg->hdrlist);
- listmsg->owner = &can->hdr[hdr];
- can->hdr[hdr].msgs++;
- }
- }
- #endif
- rt_hw_local_irq_enable(level);
- }
- /* invoke callback */
- #ifdef RT_CAN_USING_HDR
- if (can->hdr != RT_NULL && can->hdr[hdr].connected && can->hdr[hdr].filter.ind)
- {
- rt_size_t rx_length;
- RT_ASSERT(hdr < can->config.maxhdr && hdr >= 0);
- level = rt_hw_local_irq_disable();
- rx_length = can->hdr[hdr].msgs * sizeof(struct rt_can_msg);
- rt_hw_local_irq_enable(level);
- if (rx_length)
- {
- can->hdr[hdr].filter.ind(&can->parent, can->hdr[hdr].filter.args, hdr, rx_length);
- }
- }
- else
- #endif
- {
- if (can->parent.rx_indicate != RT_NULL)
- {
- rt_size_t rx_length;
- level = rt_hw_local_irq_disable();
- /* get rx length */
- rx_length = rt_list_len(&rx_fifo->uselist)* sizeof(struct rt_can_msg);
- rt_hw_local_irq_enable(level);
- if (rx_length)
- {
- can->parent.rx_indicate(&can->parent, rx_length);
- }
- }
- }
- break;
- }
- case RT_CAN_EVENT_TX_DONE:
- case RT_CAN_EVENT_TX_FAIL:
- {
- struct rt_can_tx_fifo *tx_fifo;
- rt_uint32_t no;
- no = event >> 8;
- tx_fifo = (struct rt_can_tx_fifo *) can->can_tx;
- RT_ASSERT(tx_fifo != RT_NULL);
- if (can->status.sndchange&(1<<no))
- {
- if ((event & 0xff) == RT_CAN_EVENT_TX_DONE)
- {
- tx_fifo->buffer[no].result = RT_CAN_SND_RESULT_OK;
- }
- else
- {
- tx_fifo->buffer[no].result = RT_CAN_SND_RESULT_ERR;
- }
- rt_completion_done(&(tx_fifo->buffer[no].completion));
- }
- if (can->ops->sendmsg_nonblocking != RT_NULL)
- {
- while (RT_TRUE)
- {
- struct rt_can_msg msg_to_send;
- rt_base_t level;
- rt_bool_t msg_was_present = RT_FALSE;
- level = rt_hw_local_irq_disable();
- if (rt_ringbuffer_data_len(&can->nb_tx_rb) >= sizeof(struct rt_can_msg))
- {
- rt_ringbuffer_get(&can->nb_tx_rb, (rt_uint8_t *)&msg_to_send, sizeof(struct rt_can_msg));
- msg_was_present = RT_TRUE;
- }
- rt_hw_local_irq_enable(level);
- if (!msg_was_present)
- {
- break;
- }
- if (can->ops->sendmsg_nonblocking(can, &msg_to_send) != RT_EOK)
- {
- level = rt_hw_local_irq_disable();
- rt_ringbuffer_put_force(&can->nb_tx_rb, (rt_uint8_t *)&msg_to_send, sizeof(struct rt_can_msg));
- rt_hw_local_irq_enable(level);
- break;
- }
- }
- }
- break;
- }
- }
- }
- #ifdef RT_USING_FINSH
- #include <finsh.h>
- int cmd_canstat(int argc, void **argv)
- {
- static const char *ErrCode[] =
- {
- "No Error!",
- "Warning !",
- "Passive !",
- "Bus Off !"
- };
- if (argc >= 2)
- {
- struct rt_can_status status;
- rt_device_t candev = rt_device_find(argv[1]);
- if (!candev)
- {
- rt_kprintf(" Can't find can device %s\n", argv[1]);
- return -1;
- }
- rt_kprintf(" Found can device: %s...", argv[1]);
- rt_device_control(candev, RT_CAN_CMD_GET_STATUS, &status);
- rt_kprintf("\n Receive...error..count: %010ld. Send.....error....count: %010ld.",
- status.rcverrcnt, status.snderrcnt);
- rt_kprintf("\n Bit..pad..error..count: %010ld. Format...error....count: %010ld",
- status.bitpaderrcnt, status.formaterrcnt);
- rt_kprintf("\n Ack.......error..count: %010ld. Bit......error....count: %010ld.",
- status.ackerrcnt, status.biterrcnt);
- rt_kprintf("\n CRC.......error..count: %010ld. Error.code.[%010ld]: ",
- status.crcerrcnt, status.errcode);
- switch (status.errcode)
- {
- case 0:
- rt_kprintf("%s.", ErrCode[0]);
- break;
- case 1:
- rt_kprintf("%s.", ErrCode[1]);
- break;
- case 2:
- case 3:
- rt_kprintf("%s.", ErrCode[2]);
- break;
- case 4:
- case 5:
- case 6:
- case 7:
- rt_kprintf("%s.", ErrCode[3]);
- break;
- }
- rt_kprintf("\n Total.receive.packages: %010ld. Dropped.receive.packages: %010ld.",
- status.rcvpkg, status.dropedrcvpkg);
- rt_kprintf("\n Total..send...packages: %010ld. Dropped...send..packages: %010ld.\n",
- status.sndpkg + status.dropedsndpkg, status.dropedsndpkg);
- }
- else
- {
- rt_kprintf(" Invalid Call %s\n", argv[0]);
- rt_kprintf(" Please using %s cannamex .Here canname is driver name and x is candrive number.\n", argv[0]);
- }
- return 0;
- }
- MSH_CMD_EXPORT_ALIAS(cmd_canstat, canstat, stat can device status);
- #endif
|