68 lines
2.3 KiB
C
68 lines
2.3 KiB
C
|
/*----------------------------------------------------------------------------------------------------
|
||
|
|
#
|
||
|
|
# Copyright (c) 2022 Yuankang Liang(XerolySkinner)
|
||
|
|
#
|
||
|
|
# 本软件按原样提供,无任何明示或暗示
|
||
|
|
# 在任何情况下,作者都不承担任何损害赔偿责任
|
||
|
|
#
|
||
|
|
# 使用的许可声明:
|
||
|
|
# 1. 不得歪曲本软件的来源,你不能声称你编写了原始软件.
|
||
|
|
# 2. 免费授予以任何目的,前提是版权声明出现在所有副本中.
|
||
|
|
# 并且版权声明和许可声明同时出现.
|
||
|
|
# 3. 你有使用,复制,修改,分发,和销售本软件的许可.
|
||
|
|
# 4. 如果你在产品中使用,产品文档中的声明是赞赏的但不是必须的.
|
||
|
|
# 5. 本通知不得从任何来源删除或更改.
|
||
|
|
#
|
||
|
|
# Yuankang Liang(XerolySkinner)
|
||
|
|
# E-mail:zabbcccbbaz@163.com
|
||
|
|
# QQ:2715099320
|
||
|
|
# Mobile Phone:13005636215
|
||
|
|
#
|
||
|
|
# All rights reserved.
|
||
|
|
*/
|
||
|
|
|
||
|
|
/**
|
||
|
|
* @file bsp_TP2210.c
|
||
|
|
* @brief 解包器
|
||
|
|
* @mainpage 主要信息
|
||
|
|
* @author Yuankang Liang(XerolySkinner)
|
||
|
|
* @email zabbcccbbaz@163.com
|
||
|
|
* @version V1.0.0
|
||
|
|
* @date Mon Sep 11 21:19:33 2023
|
||
|
|
|
||
|
|
*/
|
||
|
|
#include "bsp_TP2210.h"
|
||
|
|
//////////////////////////////////////////////////////////////////////////////////////////////////////
|
||
|
|
//----------------------------------------------------------------------------------------------------
|
||
|
|
// 函数
|
||
|
|
void bsp_TP2210_Unpack(u8* instr, u8* outstr, u32* outlen) {
|
||
|
|
if (instr == NULL)return;
|
||
|
|
if (outstr == NULL)return;
|
||
|
|
if (outlen == NULL)return;
|
||
|
|
u32 result=0;
|
||
|
|
u8 buff[128] = {0};
|
||
|
|
u32 inlen = 0;
|
||
|
|
result=sscanf((const char*)instr, "+NNMI:%*[^,],%d,%s", &inlen, buff);
|
||
|
|
|
||
|
|
char hex[3];
|
||
|
|
*outlen = inlen;
|
||
|
|
|
||
|
|
for (u32 i = 0; i < (*outlen); i++){
|
||
|
|
strncpy(hex, (const char*)(buff + i * 2), 2);
|
||
|
|
hex[2] = '\0';
|
||
|
|
outstr[i] = (u8)strtol(hex, NULL, 16);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
void bsp_TP2210_pack(u8* instr, u32 inlen, u8* outstr, u32* outlen) {
|
||
|
|
if (instr == NULL)return;
|
||
|
|
if (outstr == NULL)return;
|
||
|
|
if (outlen == NULL)return;
|
||
|
|
u8 buff[128] = {0};
|
||
|
|
*outlen = inlen;
|
||
|
|
for (u32 i = 0; i < inlen; i++)
|
||
|
|
sprintf((char*)(buff + i * 2), "%02X", instr[i]);
|
||
|
|
sprintf((char*)outstr, "AT+SEND=0000,%d,%s\r\n",*outlen,buff);
|
||
|
|
}
|
||
|
|
//////////////////////////////////////////////////////////////////////////////////////////////////////
|