ZCM在嵌入式MCU(RTTHREAD)上线程通讯实现

从ZCM通讯简介中我们了解到ZCM还适用于多线程应用,能够提供稳定的内部通讯机制。基于此功能实现了一个内部通讯的demo工程,实现原理:发布订阅使用通一个队列,发布时往队列中写入数据,zcm获取从同一个队列中获取数据,然后按照协议解析,就能拿到一个线程中发布的数据,并根据订阅的主题回调对应的函数执行相应的功能,此demo使用轮询的方式来获取队列中的数据,会性能不足,只是提供一种思路;需要线程中的发布订阅模型还请参考uorb来实现。

  1. 实现ZCM的发送接收功能函数

    size_t serial_get(uint8_t* data, size_t nData, void* usr)
    {
    if(recv_send_buf != NULL)
    {
    return rt_ringbuffer_get(recv_send_buf, data, nData);
    }
    return 0;
    }

    size_t serial_put(const uint8_t* data, size_t nData, void* usr)
    {
    if(recv_send_buf != NULL)
    {
    return rt_ringbuffer_put(recv_send_buf, data, nData);
    }
    return 0;
    }

2.创建ZCM对象,订阅主题

复制代码
struct rt_ringbuffer* recv_send_buf = NULL;
zcm_trans_t * serial_trans = NULL;
zcm_t * serial_zcm = NULL;

int main(void)
{
    rt_thread_t tid;
    int count = 1;
    /* set LED0 pin mode to output */
    recv_send_buf = rt_ringbuffer_create(4096);
    if(recv_send_buf == NULL)
    {
        rt_kprintf("recv send buf malloc failed\r\n");
    }
    
    serial_trans = zcm_trans_generic_serial_create(serial_get, serial_put, serial_trans, tick_now, NULL, 1514, 2048);
    serial_zcm = zcm_create_from_trans(serial_trans);
     zcm_subscribe(serial_zcm, "example", example_1_handle, NULL);
    zcm_subscribe(serial_zcm, "example", example_2_handle, NULL);
    zcm_subscribe(serial_zcm, "example", example_3_handle, NULL);
    return RT_EOK;
}

3。创建2个线程,一个线程用数据数据刷新获取订阅的主题执行回调功能,一个用发布主题主题消息到总线中。

复制代码
int64_t tick_now(void* usr)
{
    return rt_tick_get();
}

void example_1_handle(const zcm_recv_buf_t* rbuf, const char* channel, void* usr)
{
    rt_kprintf("%s, %d, %d\r\n", channel, rbuf->data_size,*((uint32_t *)rbuf->data));
}

void example_2_handle(const zcm_recv_buf_t* rbuf, const char* channel, void* usr)
{
    rt_kprintf("%s, %d, %d\r\n", channel, rbuf->data_size,*((uint32_t *)rbuf->data));
}

void example_3_handle(const zcm_recv_buf_t* rbuf, const char* channel, void* usr)
{
    rt_kprintf("%s, %d, %d\r\n", channel, rbuf->data_size,*((uint32_t *)rbuf->data));
}

void task_entry_1(void* param)
{

    while(1)
    {
        zcm_flush(serial_zcm);
        rt_thread_delay(1);
    }
}

void task_entry_2(void* param)
{
    uint32_t dt = 0;
    while(1)
    {
        dt++;
        zcm_publish(serial_zcm, "example", (uint8_t *)&dt, 1);
        rt_thread_delay(10);
    }
}



int main(void)
{
    rt_thread_t tid;
    int count = 1;
    /* set LED0 pin mode to output */
    recv_send_buf = rt_ringbuffer_create(4096);
    if(recv_send_buf == NULL)
    {
        rt_kprintf("recv send buf malloc failed\r\n");
    }
    
    serial_trans = zcm_trans_generic_serial_create(serial_get, serial_put, serial_trans, tick_now, NULL, 1514, 2048);
    serial_zcm = zcm_create_from_trans(serial_trans);
     zcm_subscribe(serial_zcm, "example", example_1_handle, NULL);
    zcm_subscribe(serial_zcm, "example", example_2_handle, NULL);
    zcm_subscribe(serial_zcm, "example", example_3_handle, NULL);
    tid = rt_thread_create("task_1", task_entry_1, RT_NULL, 1024, 9, 10);
    rt_thread_startup(tid);
    //tid = rt_thread_create("task_2", task_entry_2, RT_NULL, 1024, 10, 10);
    //rt_thread_startup(tid);
    uint32_t dt = 0;
    while(1)
    {
        dt++;
        zcm_publish(serial_zcm, "example", (uint8_t *)&dt, 1);
        rt_kprintf("send :%d\r\n", dt);
        rt_thread_delay(10);
    }
    return RT_EOK;
}
  1. 从嵌入式MCU中运行后,我们会发现三个订阅都会被回调(example_1_handle,example_2_handle,example_3_handle),并将接收的打印出来。
相关推荐
hahaha60163 小时前
模拟电路中什么时候适合使用电流传递信号,什么时候合适使用电压传递信号
stm32·单片机·嵌入式硬件
小小少年1234 小时前
基于蓝牙的stm32智能火灾烟雾报警系统设计
stm32·单片机·嵌入式硬件
Greedy Alg5 小时前
LeetCode 239. 滑动窗口最大值
数据结构·算法·leetcode
空白到白5 小时前
机器学习-KNN算法
人工智能·算法·机器学习
闪电麦坤956 小时前
数据结构:排序算法的评判标准(Criteria Used For Analysing Sorts)
数据结构·算法·排序算法
爱coding的橙子6 小时前
每日算法刷题Day65:8.27:leetcode dfs11道题,用时2h30min
算法·leetcode·深度优先
不懂机器人6 小时前
linux网络编程-----TCP服务端并发模型(epoll)
linux·网络·tcp/ip·算法
点灯小铭6 小时前
基于51单片机红外避障车辆高速汽车测速仪表设计
单片机·嵌入式硬件·汽车·毕业设计·51单片机·课程设计
地平线开发者7 小时前
理想汽车智驾方案介绍 3|MoE+Sparse Attention 高效结构解析
算法·自动驾驶
小O的算法实验室8 小时前
2025年KBS SCI1区TOP,矩阵差分进化算法+移动网络视觉覆盖无人机轨迹优化,深度解析+性能实测
算法·论文复现·智能算法改进