降低message center的冗余度,提升can_comm的接收效率并在发送增加延时保证顺序

modules/message_center/message_center.c

@@ -1,6 +1,7 @@
 #include "message_center.h"
 #include "stdlib.h"
 #include "string.h"
+#include "bsp_log.h"
 
 /* message_center是fake head node,是方便链表编写的技巧,这样就不需要处理链表头的特殊情况 */
 static Publisher_t message_center = {
@@ -12,6 +13,7 @@ static void CheckName(char *name)
 {
     if (strnlen(name, MAX_EVENT_NAME_LEN + 1) >= MAX_EVENT_NAME_LEN)
     {
+        LOGERROR("EVENT NAME TOO LONG:%s", name);
         while (1)
             ; // 进入这里说明事件名超出长度限制
     }
@@ -21,65 +23,12 @@ static void CheckLen(uint8_t len1, uint8_t len2)
 {
     if (len1 != len2)
     {
+        LOGERROR("EVENT LEN NOT SAME:%d,%d", len1, len2);
         while (1)
             ; // 进入这里说明相同事件的消息长度却不同
     }
 }
 
-Subscriber_t *SubRegister(char *name, uint8_t data_len)
-{
-    CheckName(name);
-    Publisher_t *node = &message_center; // 可以将message_center看作对消息管理器的抽象,它用于管理所有pub和sub
-    while (node->next_event_node)        // 遍历链表,如果当前有发布者已经注册
-    {
-        node = node->next_event_node;            // 指向下一个发布者(发布者发布的事件)
-        if (strcmp(name, node->event_name) == 0) // 如果事件名相同就订阅这个事件
-        {
-            CheckLen(data_len, node->data_len);
-            // 创建新的订阅者结点,申请内存,注意要memset因为新空间不一定是空的,可能有之前留存的垃圾值
-            Subscriber_t *ret = (Subscriber_t *)malloc(sizeof(Subscriber_t));
-            memset(ret, 0, sizeof(Subscriber_t));
-            // 对新建的Subscriber进行初始化
-            ret->data_len = data_len; // 设定数据长度
-            for (size_t i = 0; i < QUEUE_SIZE; ++i)
-            { // 给消息队列的每一个元素分配空间,queue里保存的实际上是数据执指针,这样可以兼容不同的数据长度
-                ret->queue[i] = malloc(sizeof(data_len));
-            }
-            // 如果是第一个订阅者,特殊处理一下
-            if (node->first_subs == NULL)
-            {
-                node->first_subs = ret;
-                return ret;
-            }
-            // 遍历订阅者链表,直到到达尾部
-            Subscriber_t *sub = node->first_subs; // 作为iterator
-            while (sub->next_subs_queue)          // 遍历订阅了该事件的订阅者链表
-            {
-                sub = sub->next_subs_queue; // 移动到下一个订阅者,遇到空指针停下,说明到了链表尾部
-            }
-            sub->next_subs_queue = ret; // 把刚刚创建的订阅者接上
-            return ret;
-        }
-        // 事件名不同,在下一轮循环访问下一个结点
-    }
-    // 遍历完,发现尚未注册事件(还没有发布者);那么创建一个事件,此时node是publisher链表的最后一个结点
-    node->next_event_node = (Publisher_t *)malloc(sizeof(Publisher_t));
-    memset(node->next_event_node, 0, sizeof(Publisher_t));
-    strcpy(node->next_event_node->event_name, name);
-    node->next_event_node->data_len = data_len;
-    // 同之前,创建subscriber作为新事件的第一个订阅者
-    Subscriber_t *ret = (Subscriber_t *)malloc(sizeof(Subscriber_t));
-    memset(ret, 0, sizeof(Subscriber_t));
-    ret->data_len = data_len;
-    for (size_t i = 0; i < QUEUE_SIZE; ++i)
-    { // 给消息队列分配空间
-        ret->queue[i] = malloc(sizeof(data_len));
-    }
-    // 新建的订阅者是该发布者的第一个订阅者,发布者会通过这个指针顺序访问所有订阅者
-    node->next_event_node->first_subs = ret;
-    return ret;
-}
-
 Publisher_t *PubRegister(char *name, uint8_t data_len)
 {
     CheckName(name);
@@ -103,6 +52,34 @@ Publisher_t *PubRegister(char *name, uint8_t data_len)
     return node->next_event_node;
 }
 
+Subscriber_t *SubRegister(char *name, uint8_t data_len)
+{
+    Publisher_t* pub = PubRegister(name, data_len); // 查找或创建该事件的发布者
+    // 创建新的订阅者结点,申请内存,注意要memset因为新空间不一定是空的,可能有之前留存的垃圾值
+    Subscriber_t *ret = (Subscriber_t *)malloc(sizeof(Subscriber_t));
+    memset(ret, 0, sizeof(Subscriber_t));
+    // 对新建的Subscriber进行初始化
+    ret->data_len = data_len; // 设定数据长度
+    for (size_t i = 0; i < QUEUE_SIZE; ++i)
+    { // 给消息队列的每一个元素分配空间,queue里保存的实际上是数据执指针,这样可以兼容不同的数据长度
+        ret->queue[i] = malloc(sizeof(data_len));
+    }
+    // 如果是第一个订阅者,特殊处理一下,将first_subs指针指向新建的订阅者(详见文档)
+    if (pub->first_subs == NULL)
+    {
+        pub->first_subs = ret;
+        return ret;
+    }
+    // 若该话题已经有订阅者, 遍历订阅者链表,直到到达尾部
+    Subscriber_t *sub = pub->first_subs; // 作为iterator
+    while (sub->next_subs_queue)          // 遍历订阅了该事件的订阅者链表
+    {
+        sub = sub->next_subs_queue; // 移动到下一个订阅者,遇到空指针停下,说明到了链表尾部
+    }
+    sub->next_subs_queue = ret; // 把刚刚创建的订阅者接上
+    return ret;
+}
+
 /* 如果队列为空,会返回0;成功获取数据,返回1;后续可以做更多的修改,比如剩余消息数目等 */
 uint8_t SubGetMessage(Subscriber_t *sub, void *data_ptr)
 {