Слияние кода завершено, страница обновится автоматически
/**
*!
* \file b_srv_protocol.c
* \version v0.0.1
* \date 2023/08/27
* \author Bean(notrynohigh@outlook.com)
*******************************************************************************
* @attention
*
* Copyright (c) 2023 Bean
*
* Permission is hereby granted, free of charge, to any person obtaining a copy
* of this software and associated documentation files (the "Software"), to deal
* in the Software without restriction, including without limitation the rights
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
* copies of the Software, and to permit persons to whom the Software is
* furnished to do so, subject to the following conditions:
*
* The above copyright notice and this permission notice shall be included in all
* copies or substantial portions of the Software.
*
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
* SOFTWARE.
*******************************************************************************
*/
/*Includes ----------------------------------------------*/
#include "services/inc/b_srv_protocol.h"
#if (defined(_PROTOCOL_SERVICE_ENABLE) && (_PROTOCOL_SERVICE_ENABLE == 1))
#include <string.h>
/**
* \addtogroup BABYOS
* \{
*/
/**
* \addtogroup SERVICES
* \{
*/
/**
* \addtogroup PROTOCOL
* \{
*/
/**
* \defgroup PROTOCOL_Private_TypesDefinitions
* \{
*/
/**
* \}
*/
/**
* \defgroup PROTOCOL_Private_Defines
* \{
*/
bSECTION_DEF_FLASH(b_srv_protocol, bProtocolInstance_t);
/**
* \}
*/
/**
* \defgroup PROTOCOL_Private_Macros
* \{
*/
/**
* \}
*/
/**
* \defgroup PROTOCOL_Private_Variables
* \{
*/
/**
* \}
*/
/**
* \defgroup PROTOCOL_Private_FunctionPrototypes
* \{
*/
/**
* \}
*/
/**
* \defgroup PROTOCOL_Private_Functions
* \{
*/
static int _bProtoCallback(bProtoCmd_t cmd, void *param, void *arg)
{
int i = 0;
bProtSrvAttr_t *pattr = (bProtSrvAttr_t *)arg;
if (arg == NULL)
{
return -1;
}
struct list_head *pos = NULL;
bProtSrvSubscribe_t *psub = NULL;
list_for_each(pos, &pattr->attr.list)
{
psub = list_entry(pos, bProtSrvSubscribe_t, list);
for (i = 0; i < psub->number; i++)
{
if (psub->pcmd_table[i] == cmd)
{
psub->callback(cmd, param);
}
}
}
if (pattr->attr.u_callback != NULL)
{
return pattr->attr.u_callback(cmd, param);
}
return 0;
}
/**
* \}
*/
/**
* \addtogroup PROTOCOL_Exported_Functions
* \{
*/
bProtSrvId_t bProtSrvInit(bProtSrvAttr_t *attr, bProtSrvGetInfo_t func)
{
if (attr == NULL)
{
return NULL;
}
bSECTION_FOR_EACH(b_srv_protocol, bProtocolInstance_t, instance)
{
if (strcmp(instance->name, attr->name) == 0)
{
attr->attr.get_info = func;
attr->attr.package = instance->package;
attr->attr.parse = instance->parse;
attr->attr.callback = _bProtoCallback;
attr->attr.arg = attr;
INIT_LIST_HEAD(&attr->attr.list);
break;
}
}
// 运行只支持解析或者打包
if (attr->attr.parse || attr->attr.package)
{
return attr;
}
return NULL;
}
// in/i_len 需要解析的数据和数据长度
// out/o_len 已经组包完成,需要回复的数据
// retval 返回值是,out中的有效数据长度。-1表示打包失败
int bProtSrvParse(bProtSrvId_t id, uint8_t *in, uint16_t i_len, uint8_t *out, uint16_t o_len)
{
int ret = -1;
bProtSrvAttr_t *pattr = (bProtSrvAttr_t *)id;
if (pattr == NULL || in == NULL)
{
return -1;
}
if (pattr->attr.parse)
{
ret = pattr->attr.parse(&pattr->attr, in, i_len, out, o_len);
}
return ret;
}
// cmd 是需要打包什么数据 \ref bProtoCmd_t
// buf 打包后的数据存放区
// buf_len buf的长度
// retval buf中有效数据长度,-1表示打包失败
int bProtSrvPackage(bProtSrvId_t id, bProtoCmd_t cmd, uint8_t *buf, uint16_t buf_len)
{
int ret = -1;
bProtSrvAttr_t *pattr = (bProtSrvAttr_t *)id;
if (pattr == NULL || buf == NULL || cmd >= B_PROTO_CMD_NUMBER)
{
return -1;
}
if (pattr->attr.package)
{
ret = pattr->attr.package(&pattr->attr, cmd, buf, buf_len);
}
return ret;
}
// 订阅协议的指令
// psub 订阅信息 \ref bProtSrvSubscribe_t
int bProtSrvSubscribe(bProtSrvId_t id, bProtSrvSubscribe_t *psub)
{
bProtSrvAttr_t *pattr = (bProtSrvAttr_t *)id;
if (pattr == NULL || psub == NULL)
{
return -1;
}
if (psub->callback == NULL || psub->number == 0 || psub->pcmd_table == NULL)
{
return -2;
}
list_add(&psub->list, &pattr->attr.list);
return 0;
}
int bProtSrvUnsubscribe(bProtSrvId_t id, bProtSrvSubscribe_t *psub)
{
bProtSrvAttr_t *pattr = (bProtSrvAttr_t *)id;
if (pattr == NULL || psub == NULL)
{
return -1;
}
struct list_head *pos = &psub->list;
struct list_head *pos_tmp = NULL;
list_for_each(pos_tmp, &pattr->attr.list)
{
if (pos_tmp == pos)
{
__list_del(pos_tmp->prev, pos_tmp->next);
return 0;
}
}
return -1;
}
/**
* \}
*/
/**
* \}
*/
/**
* \}
*/
/**
* \}
*/
#endif
/************************ Copyright (c) 2023 Bean *****END OF FILE****/
Вы можете оставить комментарий после Вход в систему
Неприемлемый контент может быть отображен здесь и не будет показан на странице. Вы можете проверить и изменить его с помощью соответствующей функции редактирования.
Если вы подтверждаете, что содержание не содержит непристойной лексики/перенаправления на рекламу/насилия/вульгарной порнографии/нарушений/пиратства/ложного/незначительного или незаконного контента, связанного с национальными законами и предписаниями, вы можете нажать «Отправить» для подачи апелляции, и мы обработаем ее как можно скорее.
Комментарий ( 0 )