luban-lite-t3e-pro/bsp/examples/test-can/test_can.c

/*
 * Copyright (c) 2022, Artinchip Technology Co., Ltd
 *
 * SPDX-License-Identifier: Apache-2.0
 */
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <rtthread.h>
#include "rtdevice.h"
#include <aic_core.h>

/*
 * This program is used to test the sending and receiving of CAN.
 * You must ensure that there are two CAN modules on the demo board.
 * CAN0 sends data and CAN1 receives data.
 * can_rx needs to be executed before can_tx.
 */
#define CAN_TX_DEV_NAME                 "can0"
#define CAN_RX_DEV_NAME                 "can1"
#define CAN_RX_FILTER_ENABLE            0

static struct rt_semaphore rx_sem;
static rt_device_t can_tx_dev;
static rt_device_t can_rx_dev;
uint8_t rxThreadInited = 0;

static rt_err_t can_rx_call(rt_device_t dev, rt_size_t size)
{
    rt_sem_release(&rx_sem);

    return RT_EOK;
}

static void can_rx_thread(void *parameter)
{
    int i;
    rt_size_t size;
    struct rt_can_msg rxmsg = {0};

    while (1)
    {
        rt_sem_take(&rx_sem, RT_WAITING_FOREVER);

        rxmsg.hdr = -1;
        size = rt_device_read(can_rx_dev, 0, &rxmsg, sizeof(rxmsg));
        if (!size)
        {
            rt_kprintf("CAN read error\n");
            break;
        }

        rt_kprintf(CAN_RX_DEV_NAME" received msg:\nID: 0x%x ", rxmsg.id);

        if (rxmsg.len)
            rt_kprintf("DATA: ");
        for (i = 0; i < rxmsg.len; i++)
        {
            rt_kprintf("%02x ", rxmsg.data[i]);
        }

        rt_kprintf("\n");
    }

    rt_device_close(can_rx_dev);
}

int test_can_rx(int argc, char *argv[])
{
    rt_err_t ret = 0;
    rt_thread_t thread;

    if (!rxThreadInited)
    {
        /* can rx configuration */
        can_rx_dev = rt_device_find(CAN_RX_DEV_NAME);
        if (!can_rx_dev)
        {
            rt_kprintf("find %s failed!\n", CAN_RX_DEV_NAME);
            return -RT_ERROR;
        }

        ret = rt_device_open(can_rx_dev,
                             RT_DEVICE_FLAG_INT_TX | RT_DEVICE_FLAG_INT_RX);
        if (ret)
        {
            rt_kprintf("%s open failed!\n", CAN_RX_DEV_NAME);
            return -RT_ERROR;
        }

        ret = rt_device_control(can_rx_dev, RT_CAN_CMD_SET_BAUD,
                                (void *)CAN1MBaud);
        if (ret)
        {
            rt_kprintf("%s set baudrate failed!\n", CAN_RX_DEV_NAME);
            ret = -RT_ERROR;
            goto __exit;
        }

#if CAN_RX_FILTER_ENABLE
        /* config can rx filter */
        struct rt_can_filter_item items[1] =
        {
            //Only receive standard data frame with ID 0x100~0x1FF
            RT_CAN_FILTER_ITEM_INIT(0x100, 0, 0, 0, 0x700, RT_NULL, RT_NULL),
        };

        struct rt_can_filter_config cfg = {1, 1, items};

        ret = rt_device_control(can_rx_dev, RT_CAN_CMD_SET_FILTER, &cfg);
#endif

        rt_device_set_rx_indicate(can_rx_dev, can_rx_call);

        rt_sem_init(&rx_sem, "rx_sem", 0, RT_IPC_FLAG_PRIO);

        thread = rt_thread_create("can_rx", can_rx_thread, RT_NULL,
                                  2048, 25, 10);
        if (thread != RT_NULL)
        {
            rt_thread_startup(thread);
        }
        else
        {
            rt_kprintf("create can_rx thread failed!\n");
            ret = -RT_ERROR;
        }

        rxThreadInited = 1;
        rt_kprintf("The "CAN_RX_DEV_NAME" received thread is ready...\n");
    }
    else
    {
        rt_kprintf("The "CAN_RX_DEV_NAME" received thread is running...\n");
    }

    return RT_EOK;

__exit:
    rt_device_close(can_rx_dev);
    return ret;
}

MSH_CMD_EXPORT_ALIAS(test_can_rx, can_rx, CAN rx sample. Usage: can_rx);

void parse_msg_data(rt_can_msg_t msg, char * optarg)
{
    char *token;
    uint8_t i = 0, id_received = 0;

    token = strtok(optarg, "#.");

    while (token)
    {
        if (!id_received)
        {
            msg->id = strtoul(token, NULL, 16);
            if (msg->id > 0x7FF)
                msg->ide = 1;
            else
                msg->ide = 0;

            id_received = 1;
        }
        else
        {
            /* frame data */
            msg->rtr = 0;
            msg->data[i++] = strtoul(token, NULL, 16);
            if (i >= 8)
                break;
        }

        token = strtok(NULL, "#.");
    }

    msg->len = i;
}

static void usage_tx(char * program)
{
    printf("\n");
    printf("%s - test CAN0 send CAN-frame.\n\n", program);
    printf("Usage: %s CAN_FRAME\n", program);
    printf("\tCAN_FRAME format: frame_id#frame_data\n");
    printf("For example:\n");
    printf("\t%s 1a3#11.22.9a.88.ef.00\n", program);
    printf("\n");
}

int test_can_tx(int argc, char *argv[])
{
    rt_err_t ret = 0;
    rt_size_t  size;
    struct rt_can_msg msg = {0};

    if (argc != 2)
    {
        usage_tx(argv[0]);
        return -RT_EINVAL;
    }

    if (!rxThreadInited)
    {
        rt_kprintf("Please execute can_rx at first!\n");
        return -RT_EINVAL;
    }

    parse_msg_data(&msg, argv[1]);

    /* can tx configuration */
    can_tx_dev = rt_device_find(CAN_TX_DEV_NAME);
    if (!can_tx_dev)
    {
        rt_kprintf("find %s failed!\n", CAN_TX_DEV_NAME);
        return -RT_EINVAL;
    }

    ret = rt_device_open(can_tx_dev,
                         RT_DEVICE_FLAG_INT_TX | RT_DEVICE_FLAG_INT_RX);
    if (ret)
    {
        rt_kprintf("%s open failed!\n", CAN_TX_DEV_NAME);
        return -RT_ERROR;
    }

    ret = rt_device_control(can_tx_dev, RT_CAN_CMD_SET_BAUD, (void *)CAN1MBaud);
    if (ret)
    {
        rt_kprintf("%s set baudrate failed!\n", CAN_TX_DEV_NAME);
        ret = -RT_ERROR;
        goto __exit;
    }

    size = rt_device_write(can_tx_dev, 0, &msg, sizeof(msg));
    if (size != sizeof(msg))
    {
        rt_kprintf("can dev write data failed!\n");
        ret = -RT_EIO;
    }

__exit:
    rt_device_close(can_tx_dev);
    return ret;
}

MSH_CMD_EXPORT_ALIAS(test_can_tx, can_tx, CAN tx sample);