725 lines
19 KiB
C
725 lines
19 KiB
C
#include "gap.h"
|
||
#include "atcmd.h"
|
||
#include "string.h"
|
||
#include "drvs.h"
|
||
#include <stdio.h>
|
||
#include "app.h"
|
||
#include "app_actv.h"
|
||
#include "gapc_api.h"
|
||
#include "gapm_api.h"
|
||
#include "att.h"
|
||
#include "uartRb.h"
|
||
#include "prf_sess.h"
|
||
#include "gatt.h"
|
||
#include "sftmr.h"
|
||
#include "regs.h"
|
||
|
||
#if (DBG_ATCMD)
|
||
#include "dbg.h"
|
||
//#define DEBUG(format, ...) debug("<%s,%d>" format , __MODULE__, __LINE__, ##__VA_ARGS__)
|
||
#define DEBUG(format, ...) debug(format, ##__VA_ARGS__)
|
||
#else
|
||
#define debug(format, ...)
|
||
#define DEBUG(format, ...)
|
||
#define debugHex(dat, len)
|
||
#endif
|
||
|
||
#define BLE_DEV_VERSION "1.0.1"
|
||
|
||
#define SYS_CONFIG_ALIGNED4_WLEN ((sizeof(SYS_CONFIG) + 3) / 4)
|
||
|
||
extern uint8_t scan_cnt;
|
||
extern struct gap_bdaddr scan_addr_list[];
|
||
|
||
uint8_t BLE_ADDR_DEFAULT[GAP_BD_ADDR_LEN] = BLE_ADDR;
|
||
struct connected_result connected_list[BLE_NB_SLAVE + BLE_NB_MASTER];
|
||
|
||
bool scan_time_out = false;
|
||
bool disconnect_all = false;
|
||
|
||
volatile uint8_t g_cfg_change;
|
||
|
||
enum cfg_chng_bits
|
||
{
|
||
CFG_CHNG_BLE = 0x01,
|
||
CFG_CHNG_SYS = 0x02,
|
||
CFG_CHNG_RST = 0x04,
|
||
};
|
||
|
||
AT_CMD_FORMAT_T at_cmd_head_list[CMD_CODE_MAX] =
|
||
{
|
||
[CMD_ECHO] = {5, 5, "AT+\r\n" },
|
||
[CMD_ALL] = {8, 8, "AT+ALL\r\n" },
|
||
[CMD_MAC_R] = {9, 9, "AT+MAC?\r\n" },
|
||
[CMD_VER_R] = {9, 9, "AT+VER?\r\n" },
|
||
[CMD_NAME_R] = {14, 14, "AT+DEV_NAME?\r\n" },
|
||
[CMD_NAME_S] = {12, 34, "AT+DEV_NAME=" },
|
||
[CMD_BAUD_R] = {10, 10, "AT+BAUD?\r\n" },
|
||
[CMD_BAUD_S] = {8, 16, "AT+BAUD=" },
|
||
[CMD_DISCON_S] = {13, 13, "AT+DISCON=1\r\n" },
|
||
[CMD_SCAN_S] = {15, 15, "AT+SCAN_BLE=1\r\n"},
|
||
[CMD_CON_MAC_R] = {13, 13, "AT+CON_MAC?\r\n" },
|
||
[CMD_CON_MAC_S] = {11, 30, "AT+CON_MAC=" },
|
||
[CMD_UUIDS_R] = {11, 11, "AT+UUIDS?\r\n" },
|
||
[CMD_UUIDS_S] = {9, 43, "AT+UUIDS=" },
|
||
[CMD_UUIDN_R] = {11, 11, "AT+UUIDN?\r\n" },
|
||
[CMD_UUIDN_S] = {9, 43, "AT+UUIDN=" },
|
||
[CMD_UUIDW_R] = {11, 11, "AT+UUIDW?\r\n" },
|
||
[CMD_UUIDW_S] = {9, 43, "AT+UUIDW=" },
|
||
[CMD_AINTVL_R] = {12, 12, "AT+AINTVL?\r\n" },
|
||
[CMD_AINTVL_S] = {10, 16, "AT+AINTVL=" },
|
||
[CMD_AMDATA_R] = {12, 12, "AT+AMDATA?\r\n" },
|
||
[CMD_AMDATA_S] = {10, 38, "AT+AMDATA=" },
|
||
[CMD_RENEW_S] = {10, 10, "AT+RENEW\r\n" },
|
||
[CMD_RESET_S] = {10, 10, "AT+RESET\r\n" },
|
||
[CMD_HELP] = {9, 9, "AT+HELP\r\n" },
|
||
};
|
||
|
||
/*
|
||
* LOCAL FUNCTION DEFINITIONS
|
||
****************************************************************************************
|
||
*/
|
||
void at_uart_baud_cfg(uint8_t port, uint32_t uart_baud)
|
||
{
|
||
UART_TypeDef* uart = ((UART_TypeDef *)(UART1_BASE + (port) * 0x1000));
|
||
|
||
uint16_t uart_baud_div = (uint16_t)((rcc_sysclk_freq() + ((uart_baud) >> 1)) / (uart_baud));
|
||
|
||
// update BaudRate
|
||
uart->LCR.BRWEN = 1;
|
||
uart->BRR = uart_baud_div;
|
||
uart->LCR.BRWEN = 0;
|
||
}
|
||
|
||
void atConfigFlashWrite(uint32_t offset, uint8_t len, const uint32_t *data)
|
||
{
|
||
flash_page_erase(offset);
|
||
flash_write(offset, (uint32_t *)data, len);
|
||
}
|
||
|
||
void atConfigFlashRead(void)
|
||
{
|
||
uint32_t config_data[SYS_CONFIG_ALIGNED4_WLEN];
|
||
flash_read(SYS_CONFIG_OFFSET, config_data, SYS_CONFIG_ALIGNED4_WLEN);
|
||
|
||
g_cfg_change = 0;
|
||
|
||
for (uint8_t i = 0; i < SYS_CONFIG_ALIGNED4_WLEN; i++)
|
||
{
|
||
if (config_data[i] != 0xFFFFFFFF)
|
||
{
|
||
memcpy((uint8_t *)&sys_config, (uint8_t *)&config_data, sizeof(SYS_CONFIG));
|
||
|
||
break;
|
||
}
|
||
}
|
||
|
||
at_uart_baud_cfg(UART1_PORT, sys_config.baudrate);
|
||
}
|
||
|
||
SYS_CONFIG sys_config =
|
||
{
|
||
.baudrate = AT_DFT_UART_BAUD,
|
||
.mac_addr = BLE_ADDR,
|
||
.uuid_len = ATT_UUID16_LEN,
|
||
.uuids = {0xF0, 0xFF},
|
||
.uuidn = {0xF1, 0xFF},
|
||
.uuidw = {0xF2, 0xFF},
|
||
.name_len = sizeof(BLE_DEV_NAME) - 1,
|
||
.name = BLE_DEV_NAME,
|
||
|
||
.adv_data_len = AT_DFT_ADV_DATA_LEN,
|
||
.adv_data =
|
||
{
|
||
0x02, 0x01, 0x06,
|
||
0x03, 0x03, 0xF0, 0xFF,
|
||
0x03, 0x19, 0x00, 0x00
|
||
},
|
||
.adv_intv_time= AT_DFT_ADV_INTV,
|
||
.rssi = AT_DFT_RSSI,
|
||
};
|
||
|
||
// flag: All_FACTORY_REST: ȫ<><C8AB><EFBFBD>ָ<EFBFBD><D6B8><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||
// flag: PAIR_FACTORY_RESET: <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ϣ
|
||
void atSetBleDefault(PARA_SET_FACTORY flag)
|
||
{
|
||
// uint8_t uuid16_idx = 12;
|
||
|
||
if (flag == All_FACTORY_REST)
|
||
{
|
||
// sys_config;
|
||
memset(sys_config.adv_data, 0, sizeof(sys_config.adv_data));
|
||
for (uint8_t idx = 0; idx < sys_config.adv_data_len; idx++)
|
||
{
|
||
sys_config.adv_data[idx] = idx;
|
||
}
|
||
|
||
// sys_config.rssi = 0; // RSSI <20>ź<EFBFBD>ֵ
|
||
|
||
// sys_config.adv_intv_time = 20; //min
|
||
|
||
// sys_config.uuid_len = ATT_UUID16_LEN;
|
||
|
||
// if (sys_config.uuid_len == ATT_UUID128_LEN) uuid16_idx = 0;
|
||
|
||
// memcpy(sys_config.uuids, &ses_uuid_s[uuid16_idx], sys_config.uuid_len);
|
||
// memcpy(sys_config.uuidn, &ses_uuid_n[uuid16_idx], sys_config.uuid_len);
|
||
// memcpy(sys_config.uuidw, &ses_uuid_w[uuid16_idx], sys_config.uuid_len);
|
||
}
|
||
// else if(flag == PAIR_FACTORY_RESET)
|
||
// {
|
||
// //sprintf((char*)sys_config.pass, "000000"); //<2F><><EFBFBD><EFBFBD>
|
||
//// memset(sys_config.mac_addr, 0, sizeof(sys_config.mac_addr));
|
||
//// memcpy(sys_config.mac_addr, BLE_ADDR_DEFAULT, GAP_BD_ADDR_LEN);
|
||
// sys_config.ever_connect_peripheral_mac_addr_conut = 0;
|
||
// sys_config.ever_connect_peripheral_mac_addr_index = 0;
|
||
// }
|
||
|
||
// GAPBondMgr_SetParameter( GAPBOND_ERASE_ALLBONDS, 0, NULL ); //<2F><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ϣ
|
||
|
||
atConfigFlashWrite(SYS_CONFIG_OFFSET, sizeof(SYS_CONFIG), (uint32_t *)&sys_config);
|
||
}
|
||
|
||
#if (0)
|
||
// <20>ַ<EFBFBD><D6B7><EFBFBD><EFBFBD>Ա<EFBFBD>
|
||
static uint8_t strCmp(const uint8_t *p1, char *p2, uint8_t len)
|
||
{
|
||
uint8_t i = 0;
|
||
while (i < len)
|
||
{
|
||
if (p1[i] != p2[i])
|
||
{
|
||
return 0;
|
||
}
|
||
i++;
|
||
}
|
||
return 1;
|
||
}
|
||
#endif
|
||
|
||
// <20>ַ<EFBFBD><D6B7><EFBFBD>ת<EFBFBD><D7AA><EFBFBD><EFBFBD>
|
||
uint32_t str2Num(const uint8_t *numStr, uint8_t iLength)
|
||
{
|
||
uint32_t rtnInt = 0;
|
||
|
||
#if (__MICROLIB)
|
||
rtnInt = strtoul((const char *)numStr, NULL, 10);
|
||
#else
|
||
/*
|
||
Ϊ<><CEAA><EFBFBD><EFBFBD><EFBFBD><EFBFBD><F2B5A5A3><EFBFBD>ȷ<EFBFBD><C8B7><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ַ<EFBFBD><D6B7><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ֵ<EFBFBD>
|
||
<20><><EFBFBD><EFBFBD><EFBFBD>£<EFBFBD><C2A3>˴<EFBFBD>δ<EFBFBD><CEB4><EFBFBD><EFBFBD><EFBFBD>飬<EFBFBD><E9A3AC><EFBFBD><EFBFBD>Ҫ<EFBFBD><D2AA><EFBFBD><EFBFBD>
|
||
numStr[i] - '0'<27>Ƿ<EFBFBD><C7B7><EFBFBD>[0, 9]<5D><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||
*/
|
||
|
||
for (uint8_t i = 0; (i < iLength) && (numStr[i] != '\0'); i++)
|
||
{
|
||
rtnInt = rtnInt * 10 + (numStr[i] - '0');
|
||
}
|
||
#endif
|
||
|
||
return rtnInt;
|
||
}
|
||
|
||
__INLINE__ uint8_t co_hexstr2hex(uint8_t hex_str)
|
||
{
|
||
return (hex_str <= '9') ? (hex_str - '0') :
|
||
((hex_str <= 'F') ? (hex_str - 'A' + 10) : (hex_str - 'a' + 10));
|
||
}
|
||
|
||
void str2mac(const uint8_t *date)
|
||
{
|
||
uint8_t *buff = (uint8_t *)date;
|
||
uint8_t j = (GAP_BD_ADDR_LEN - 1);
|
||
|
||
for (uint8_t i = 0; i < 17; i++)
|
||
{
|
||
buff[i] = co_hexstr2hex(buff[i]);
|
||
|
||
if ((i % 3) == 1)
|
||
{
|
||
sys_config.connect_mac_addr[j--] = (buff[i - 1] << 4) + buff[i];
|
||
i++; //<2F><><EFBFBD><EFBFBD>:
|
||
}
|
||
}
|
||
}
|
||
|
||
void hexstr2hex(uint8_t str_len, const uint8_t *hex_str, uint8_t *hex)
|
||
{
|
||
uint8_t *buff = (uint8_t *)hex_str;
|
||
|
||
for (uint8_t i = 0; i < str_len; i++)
|
||
{
|
||
buff[i] = co_hexstr2hex(buff[i]);
|
||
|
||
// <20><><EFBFBD><EFBFBD><EFBFBD>ַ<EFBFBD>ƴ<EFBFBD><C6B4>һ<EFBFBD><D2BB>hex
|
||
if (i & 0x01)
|
||
{
|
||
hex[i / 2] = (buff[i - 1] << 4) | buff[i];
|
||
}
|
||
}
|
||
}
|
||
void str2uuid(uint8_t str_len, const uint8_t *date, uint8_t *uuid)
|
||
{
|
||
uint8_t *buff = (uint8_t *)date;
|
||
|
||
for (uint8_t i = 0; i < str_len; i++)
|
||
{
|
||
buff[i] = co_hexstr2hex(buff[i]);
|
||
|
||
// <20><><EFBFBD><EFBFBD><EFBFBD>ַ<EFBFBD>ƴ<EFBFBD><C6B4>һ<EFBFBD><D2BB>hex
|
||
if (i & 0x01)
|
||
{
|
||
uuid[(str_len - i) / 2] = (buff[i - 1] << 4) + buff[i];
|
||
}
|
||
}
|
||
}
|
||
|
||
#define debugHexB(dat, len) \
|
||
do \
|
||
{ \
|
||
for (int i = 1; i <= len; i++) \
|
||
{ \
|
||
DEBUG("%02X", *((dat + len) - i));\
|
||
} \
|
||
DEBUG("\r\n"); \
|
||
} while (0)
|
||
|
||
void debugMAC(uint8_t *addr)
|
||
{
|
||
for (uint8_t idx = GAP_BD_ADDR_LEN; idx > 0; idx--)
|
||
{
|
||
DEBUG("%02X", addr[idx - 1]);
|
||
DEBUG("%s", idx > 1 ? ":" : "\r\n");
|
||
}
|
||
}
|
||
|
||
// <20><>ӡ<EFBFBD><D3A1><EFBFBD>д洢<D0B4><E6B4A2><EFBFBD><EFBFBD><EFBFBD>ݣ<EFBFBD><DDA3><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Դ<EFBFBD><D4B4><EFBFBD>
|
||
void printAllConfigData(void)
|
||
{
|
||
DEBUG("Name = %s\r\n", sys_config.name);
|
||
|
||
DEBUG("Version = %s\r\n", BLE_DEV_VERSION);
|
||
|
||
DEBUG("Mac_Addr = %02X:%02X:%02X:%02X:%02X:%02X\r\n", sys_config.mac_addr[5], sys_config.mac_addr[4],
|
||
sys_config.mac_addr[3], sys_config.mac_addr[2], sys_config.mac_addr[1], sys_config.mac_addr[0]);
|
||
|
||
DEBUG("[DA]+AMDATA= 0x");
|
||
debugHexB(sys_config.adv_data, sys_config.adv_data_len);
|
||
|
||
DEBUG("UUIDS = 0x");
|
||
debugHexB(sys_config.uuids, sys_config.uuid_len);
|
||
|
||
DEBUG("UUIDN = 0x");
|
||
debugHexB(sys_config.uuidn, sys_config.uuid_len);
|
||
|
||
DEBUG("UUIDW = 0x");
|
||
debugHexB(sys_config.uuidw, sys_config.uuid_len);
|
||
|
||
DEBUG("Rssi = %d\r\n", sys_config.rssi);
|
||
|
||
DEBUG("Adv_Intv = %d\r\n", (sys_config.adv_intv_time * 5)/8);
|
||
|
||
DEBUG("Baudrate = %d\r\n", sys_config.baudrate);
|
||
|
||
DEBUG("Connected = %d\r\n\r\n", co_ones(app_env.conbits));
|
||
}
|
||
|
||
void printATHelp(void)
|
||
{
|
||
for (uint8_t idx = CMD_ECHO; idx < CMD_CODE_MAX; idx++)
|
||
{
|
||
// sprintf((char *)&str_help, "\r\n");
|
||
|
||
DEBUG("%d:%s", idx,at_cmd_head_list[idx].str);
|
||
|
||
if (at_cmd_head_list[idx].str_len_min != at_cmd_head_list[idx].str_len_max)
|
||
{
|
||
DEBUG("\r\n");
|
||
}
|
||
}
|
||
}
|
||
|
||
tmr_tk_t printScanMac(uint8_t id)
|
||
{
|
||
for (uint8_t idx = 0; idx < scan_cnt; idx++)
|
||
{
|
||
DEBUG("[%d]", idx);
|
||
debugMAC((uint8_t *)&scan_addr_list[idx++].addr.addr);
|
||
}
|
||
DEBUG("[AT]Scan end\r\n");
|
||
|
||
return 0;
|
||
}
|
||
|
||
void atBleTx(const uint8_t *buff, uint8_t buff_len)
|
||
{
|
||
if (app_env.conrole & (0x01 << app_env.curidx)) // Slaver send to Master
|
||
{
|
||
sess_txd_send(app_env.curidx, buff_len, buff);
|
||
}
|
||
else // Master write to Slaver
|
||
{
|
||
// sesc_rxd_write(app_env.curidx, GATT_WRITE_NO_RESPONSE, buff_len, (uint8_t *)&buff);
|
||
}
|
||
}
|
||
|
||
bool atProc(const uint8_t *buff, uint8_t buff_len)
|
||
{
|
||
uint8_t code_idx = CMD_NULL;
|
||
// debug("buff_len[%d]\r\n", buff_len);
|
||
|
||
if (memcmp(buff, "AT+", 3) != 0)
|
||
{
|
||
return 0;
|
||
}
|
||
|
||
for (uint8_t idx = CMD_NULL; idx < CMD_CODE_MAX; idx++)
|
||
{
|
||
if ((at_cmd_head_list[idx].str_len_min <= buff_len) && (buff_len <= at_cmd_head_list[idx].str_len_max))
|
||
{
|
||
if (memcmp(buff, at_cmd_head_list[idx].str, at_cmd_head_list[idx].str_len_min) == 0)
|
||
{
|
||
if (at_cmd_head_list[idx].str_len_min != at_cmd_head_list[idx].str_len_max)
|
||
{
|
||
if ((memcmp(&buff[buff_len - 2], "\r\n", 2) == 0) || (idx == CMD_AMDATA_S))
|
||
{
|
||
code_idx = idx;
|
||
}
|
||
}
|
||
else
|
||
{
|
||
code_idx = idx;
|
||
}
|
||
}
|
||
}
|
||
}
|
||
|
||
switch (code_idx)
|
||
{
|
||
case CMD_NULL:
|
||
{
|
||
DEBUG("[AT]ERR[%d]\r\n", ERR_PROTOCOL);
|
||
} break;
|
||
|
||
case CMD_ECHO:
|
||
{
|
||
DEBUG("[AT]OK\r\n");
|
||
} break;
|
||
|
||
case CMD_ALL:
|
||
{
|
||
printAllConfigData();
|
||
} break;
|
||
|
||
case CMD_MAC_R:
|
||
{
|
||
DEBUG("[AT]OK\r\n");
|
||
DEBUG("[DA]+MAC=");
|
||
debugMAC(sys_config.mac_addr);
|
||
} break;
|
||
|
||
case CMD_VER_R:
|
||
{
|
||
DEBUG("[AT]OK\r\n");
|
||
DEBUG("[DA]%s\r\n", BLE_DEV_VERSION);
|
||
} break;
|
||
|
||
case CMD_NAME_R:
|
||
{
|
||
DEBUG("[AT]OK\r\n");
|
||
DEBUG("[DA]+DEV_NAME=%s\r\n", sys_config.name);
|
||
} break;
|
||
|
||
case CMD_NAME_S:
|
||
{
|
||
memset(sys_config.name, 0, sizeof(sys_config.name));
|
||
sys_config.name_len = buff_len - 14;
|
||
memcpy(sys_config.name, &buff[12], sys_config.name_len); // "\r\n"
|
||
DEBUG("[AT]OK %s\r\n", sys_config.name);
|
||
|
||
g_cfg_change = (CFG_CHNG_SYS | CFG_CHNG_BLE);
|
||
} break;
|
||
|
||
case CMD_BAUD_R:
|
||
{
|
||
DEBUG("[AT]OK\r\n");
|
||
DEBUG("[DA]+Baudrate=%d\r\n", sys_config.baudrate);
|
||
} break;
|
||
|
||
case CMD_BAUD_S:
|
||
{
|
||
uint32_t baud = str2Num(&buff[8], buff_len - 10);
|
||
|
||
if ((4800 <= baud) && (baud <= 921600))
|
||
{
|
||
if (sys_config.baudrate != baud)
|
||
{
|
||
sys_config.baudrate = baud;
|
||
}
|
||
DEBUG("[AT]OK %d\r\n", sys_config.baudrate);
|
||
|
||
g_cfg_change = (CFG_CHNG_SYS | CFG_CHNG_RST);
|
||
}
|
||
else
|
||
{
|
||
DEBUG("[AT]ERR[%d]\r\n", ERR_INVALID);
|
||
}
|
||
} break;
|
||
|
||
case CMD_DISCON_S:
|
||
{
|
||
if (app_state_get() == APP_CONNECTED)
|
||
{
|
||
DEBUG("[AT]OK\r\n");
|
||
disconnect_all = true;
|
||
gapc_disconnect(app_env.curidx);
|
||
}
|
||
else
|
||
{
|
||
DEBUG("[AT]ERR[%d]\r\n", ERR_OPERATION);
|
||
}
|
||
} break;
|
||
|
||
case CMD_SCAN_S:
|
||
// <20><>ʼɨ<CABC><C9A8>
|
||
if (app_state_get() >= APP_IDLE)
|
||
{
|
||
DEBUG("[AT]OK\r\n");
|
||
DEBUG("[AT]Scanning\r\n");
|
||
|
||
app_scan_action(ACTV_START);
|
||
|
||
#if ((LED_PLAY) || (CFG_SFT_TMR))
|
||
sftmr_start(500, printScanMac);
|
||
#endif
|
||
}
|
||
else
|
||
{
|
||
DEBUG("[AT]ERR[%d]\r\n", ERR_OPERATION);
|
||
} break;
|
||
|
||
case CMD_CON_MAC_R:
|
||
{
|
||
DEBUG("[AT]OK\r\n");
|
||
|
||
uint8_t con_num_bit = app_env.conbits;
|
||
if (con_num_bit == 0)
|
||
{
|
||
DEBUG("No Connected\r\n");
|
||
break;
|
||
}
|
||
|
||
uint8_t con_num = 0;
|
||
|
||
while (con_num_bit)
|
||
{
|
||
DEBUG("[DA]Connected=");
|
||
|
||
if (con_num_bit & 0x01)
|
||
{
|
||
debugMAC(connected_list[con_num].paddr.addr.addr);
|
||
}
|
||
|
||
con_num++;
|
||
con_num_bit >>= 1;
|
||
}
|
||
} break;
|
||
|
||
case CMD_CON_MAC_S:
|
||
{
|
||
app_init_action(ACTV_STOP); // 20211101
|
||
str2mac(&buff[11]);
|
||
|
||
struct gap_bdaddr peer;
|
||
|
||
memcpy(peer.addr.addr, sys_config.connect_mac_addr, GAP_BD_ADDR_LEN);
|
||
|
||
peer.addr_type = (peer.addr.addr[GAP_BD_ADDR_LEN-1] < 0xC0 ? 0 : 1);
|
||
|
||
DEBUG("[AT]OK\r\n");
|
||
DEBUG("[DA]Connecting\r\n");
|
||
DEBUG("[DA]Connected=");
|
||
|
||
debugMAC(sys_config.connect_mac_addr);
|
||
|
||
app_start_initiating(&peer);
|
||
} break;
|
||
|
||
case CMD_UUIDS_R:
|
||
{
|
||
DEBUG("[AT]OK\r\n");
|
||
DEBUG("[DA]+UUIDS=0x");
|
||
debugHexB(sys_config.uuids, sys_config.uuid_len);
|
||
} break;
|
||
|
||
case CMD_UUIDS_S:
|
||
{
|
||
uint8_t id_len = (buff_len - 11) / 2;
|
||
|
||
if ((id_len == ATT_UUID16_LEN) || (id_len == ATT_UUID128_LEN))
|
||
{
|
||
sys_config.uuid_len = id_len;
|
||
str2uuid(2 * id_len, &buff[9], sys_config.uuids);
|
||
|
||
DEBUG("[AT]OK\r\n");
|
||
g_cfg_change = (CFG_CHNG_SYS | CFG_CHNG_BLE);
|
||
}
|
||
else
|
||
{
|
||
DEBUG("[AT]ERR[%d]\r\n", ERR_INVALID);
|
||
}
|
||
} break;
|
||
|
||
case CMD_UUIDN_R:
|
||
{
|
||
DEBUG("[AT]OK\r\n");
|
||
DEBUG("[DA]+UUIDN=0x");
|
||
debugHexB(sys_config.uuidn, sys_config.uuid_len);
|
||
} break;
|
||
|
||
case CMD_UUIDN_S:
|
||
{
|
||
uint8_t id_len = (buff_len - 11) / 2;
|
||
|
||
if (id_len == sys_config.uuid_len)
|
||
{
|
||
str2uuid(2 * id_len, &buff[9], sys_config.uuidn);
|
||
DEBUG("[AT]OK\r\n");
|
||
|
||
g_cfg_change = (CFG_CHNG_SYS | CFG_CHNG_BLE);
|
||
}
|
||
else
|
||
{
|
||
DEBUG("[AT]ERR[%d]\r\n", ERR_INVALID);
|
||
}
|
||
} break;
|
||
|
||
case CMD_UUIDW_R:
|
||
{
|
||
DEBUG("[AT]OK\r\n");
|
||
DEBUG("[DA]+UUIDW=0x");
|
||
debugHexB(sys_config.uuidw, sys_config.uuid_len);
|
||
} break;
|
||
|
||
case CMD_UUIDW_S:
|
||
{
|
||
uint8_t id_len = (buff_len - 11) / 2;
|
||
|
||
if (id_len == sys_config.uuid_len)
|
||
{
|
||
str2uuid(2 * id_len, &buff[9], sys_config.uuidw);
|
||
DEBUG("[AT]OK\r\n");
|
||
|
||
g_cfg_change = (CFG_CHNG_SYS | CFG_CHNG_BLE);
|
||
}
|
||
else
|
||
{
|
||
DEBUG("[AT]ERR[%d]\r\n", ERR_INVALID);
|
||
}
|
||
} break;
|
||
|
||
case CMD_AINTVL_R:
|
||
{
|
||
// adv intv unit 0.625
|
||
uint16_t adv_intv_val = (uint16_t)(sys_config.adv_intv_time * 5)/8;
|
||
DEBUG("[AT]OK\r\n");
|
||
DEBUG("[DA]+AINTVL=%d\r\n", adv_intv_val);
|
||
} break;
|
||
|
||
case CMD_AINTVL_S:
|
||
{
|
||
uint16_t value = str2Num(&buff[10], buff_len - 12);
|
||
DEBUG("value:%d\r\n", value);
|
||
// adv intv unit 0.625
|
||
value = (value * 8 / 5);
|
||
if ((0x20 <= value) && (value <= 5000))
|
||
{
|
||
sys_config.adv_intv_time = value;
|
||
DEBUG("[AT]OK\r\n");
|
||
|
||
g_cfg_change = (CFG_CHNG_SYS | CFG_CHNG_BLE);
|
||
}
|
||
else
|
||
{
|
||
DEBUG("[AT]ERR[%d]\r\n", ERR_INVALID);
|
||
}
|
||
} break;
|
||
|
||
case CMD_AMDATA_R:
|
||
{
|
||
DEBUG("[DA]+AMDATA=");
|
||
debugHex(sys_config.adv_data, sys_config.adv_data_len);
|
||
} break;
|
||
|
||
case CMD_AMDATA_S:
|
||
{
|
||
uint8_t len = buff_len - 12;
|
||
|
||
if (len <= 30)
|
||
{
|
||
#if (1)
|
||
if (len & 0x01)
|
||
{
|
||
DEBUG("[AT]ERR[%d]\r\n", ERR_INVALID);
|
||
break;
|
||
}
|
||
sys_config.adv_data_len = len/2;
|
||
hexstr2hex(len, (buff + 10), sys_config.adv_data);
|
||
|
||
#else
|
||
memcpy(sys_config.adv_data, &buff[10], sys_config.adv_data_len);
|
||
#endif
|
||
DEBUG("[AT]OK\r\n");
|
||
|
||
g_cfg_change = (CFG_CHNG_SYS | CFG_CHNG_BLE);
|
||
}
|
||
else
|
||
{
|
||
DEBUG("[AT]ERR[%d]\r\n", ERR_INVALID);
|
||
}
|
||
} break;
|
||
|
||
case CMD_RENEW_S:
|
||
{
|
||
// atSetBleDefault(All_FACTORY_REST);
|
||
flash_page_erase(SYS_CONFIG_OFFSET);
|
||
};// break; // no break, used CMD_RESET_S break
|
||
|
||
case CMD_RESET_S:
|
||
{
|
||
DEBUG("[AT]OK\r\n");
|
||
g_cfg_change = CFG_CHNG_RST;// ֱ<><D6B1><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||
} break;
|
||
|
||
case CMD_HELP:
|
||
printATHelp();
|
||
break;
|
||
|
||
default:
|
||
DEBUG("[AT]ERR[%d]\r\n", ERR_PROTOCOL);
|
||
break;
|
||
}
|
||
|
||
// DEBUG("cfg:%X\r\n", g_cfg_change);
|
||
|
||
if (g_cfg_change & CFG_CHNG_BLE)
|
||
{
|
||
gapm_reset();
|
||
}
|
||
|
||
if (g_cfg_change & CFG_CHNG_SYS)
|
||
{
|
||
atConfigFlashWrite(SYS_CONFIG_OFFSET, SYS_CONFIG_ALIGNED4_WLEN, (uint32_t *)&sys_config);
|
||
}
|
||
|
||
if (g_cfg_change & CFG_CHNG_RST)
|
||
{
|
||
#if ((LED_PLAY) || (CFG_SFT_TMR))
|
||
sftmr_wait(6); // <20><><EFBFBD>ò<EFBFBD><C3B2><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ʵ<EFBFBD><CAB5><EFBFBD>ʱ,<2C>Ա<EFBFBD><D4B1><EFBFBD>һ<EFBFBD>η<EFBFBD><CEB7>͵<EFBFBD><CDB5><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ͳ<EFBFBD>ȥ
|
||
#endif
|
||
NVIC_SystemReset();
|
||
}
|
||
|
||
return (code_idx ? 1 : 0);
|
||
}
|