From fc78430a35be252a1cd5a29b5b66290a68cd9ca3 Mon Sep 17 00:00:00 2001
From: yincheng.zhong <634916154@qq.com>
Date: 星期二, 27 八月 2024 17:21:18 +0800
Subject: [PATCH] Merge branch '安邦测距手环' of http://47.108.70.204:60062/r/ChinaUWBProject into 安邦测距手环
---
keil/include/drivers/serial_at_cmd_app.c | 507 ++++++++++++++++---------------------------------------
1 files changed, 150 insertions(+), 357 deletions(-)
diff --git a/keil/include/drivers/serial_at_cmd_app.c b/keil/include/drivers/serial_at_cmd_app.c
index 763b933..3776eee 100644
--- a/keil/include/drivers/serial_at_cmd_app.c
+++ b/keil/include/drivers/serial_at_cmd_app.c
@@ -29,7 +29,7 @@
extern void updata_led_power_state(void);
extern uint8_t gps_success_state;
extern uint8_t gps_success_state,gps_enable_flag,gps_need_data_flag,gps_timeout_flag;
-extern int gps_wait_count;
+extern uint16_t gps_wait_count;
typedef enum
{
BLE_RECV_STATE_IDLE = 0,
@@ -42,7 +42,7 @@
{
char m_pData[100];
uint32_t m_u32Len;
-}GGA_DataStruct;
+} GGA_DataStruct;
typedef struct
{
E_BLERecvState m_eState;
@@ -57,7 +57,7 @@
uint8_t mUsart2ReceivePack_before , mUsart2ReceivePack_now;
uint8_t j_ct=0,CT_satrt_temp=0,CT_satrt=0,numb_base=0 ;
-uint8_t id_cmpare[12]={0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x30, 0x30, 0x30, 0x31};//123456780001//测试//RC2202A：
+uint8_t id_cmpare[12]= {0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x30, 0x30, 0x30, 0x31}; //123456780001//测试//RC2202A：
uint32_t CT_sum=0;
char char_broadcast_data[80];//广播数据
@@ -70,7 +70,7 @@
uint16_t temp_16,temp_16_id,temp_16_distance,data_buff_start;
-uint16_t Checksum_u16(uint8_t* pdata, uint32_t len)
+uint16_t Checksum_u16(uint8_t* pdata, uint32_t len)
{
uint16_t sum = 0;
uint32_t i;
@@ -82,24 +82,24 @@
void SendComMap(uint8_t data_length, uint8_t index)//表示成功读取的回应包
{
- static uint8_t send_frame[EUART_RX_BUF_SIZE];
- uint16_t checksum = 0;
- send_frame[0] = 0x55;
- send_frame[1] = 0xAA;
- send_frame[2] = 0x03;
- send_frame[3] = data_length+5;
- send_frame[4] = CMD_REPLY;
- send_frame[5] = index;
- send_frame[6] = data_length;
- memcpy(&send_frame[7], &g_com_map[index], data_length);
- for(int i = 0; i<(data_length+5); i++)
- {
- checksum += send_frame[2+i];
- }
- checksum = Checksum_u16(&send_frame[2],5+data_length);
- memcpy(&send_frame[7+data_length],&checksum,2);
-
- uart_send(UART_ID1, send_frame,data_length+9, NULL);
+ static uint8_t send_frame[EUART_RX_BUF_SIZE];
+ uint16_t checksum = 0;
+ send_frame[0] = 0x55;
+ send_frame[1] = 0xAA;
+ send_frame[2] = 0x03;
+ send_frame[3] = data_length+5;
+ send_frame[4] = CMD_REPLY;
+ send_frame[5] = index;
+ send_frame[6] = data_length;
+ memcpy(&send_frame[7], &g_com_map[index], data_length);
+ for(int i = 0; i<(data_length+5); i++)
+ {
+ checksum += send_frame[2+i];
+ }
+ checksum = Checksum_u16(&send_frame[2],5+data_length);
+ memcpy(&send_frame[7+data_length],&checksum,2);
+
+ uart_send(UART_ID1, send_frame,data_length+9, NULL);
}
void UpdateProcess(uint8_t index)
{
@@ -110,365 +110,158 @@
__disable_irq();
result = flash_open(FLASH_ID0,NULL);
if(!result)//打开成功
- flash_erase(FLASH_ID0,APP_CONFIG_IAPFLAG_SECTOR_ADDR,FLASH_SECTOR_SIZE);
- result = flash_write_nbytes(FLASH_ID0,APP_CONFIG_IAPFLAG_MAP,(uint8_t*)&tmp,2);
+ flash_erase(FLASH_ID0,APP_CONFIG_IAPFLAG_SECTOR_ADDR,FLASH_SECTOR_SIZE);
+ result = flash_write_nbytes(FLASH_ID0,APP_CONFIG_IAPFLAG_MAP,(uint8_t*)&tmp,2);
__enable_irq();
Serial0PutString("进入升级模式\r\n");
g_com_map[CNT_UPDATE]=0;
save_com_map_to_flash();
delay_us(100000);
- NVIC_SystemReset(); //软复位回到bootloader
+ NVIC_SystemReset(); //软复位回到bootloader
}
if(index == 2*CNT_REBOOT)
- { g_com_map[CNT_REBOOT]=0;
+ { g_com_map[CNT_REBOOT]=0;
g_com_map[MAP_SIGN_INDEX]=0;
save_com_map_to_flash();
- delay_us(100000);
- NVIC_SystemReset(); //软复位回到bootloader
+ delay_us(100000);
+ NVIC_SystemReset(); //软复位回到bootloader
}
if(index == 2*CNT_RESTART)
{
g_com_map[CNT_RESTART]=0;
save_com_map_to_flash();
- delay_us(100000);
- NVIC_SystemReset(); //软复位回到bootloader
+ delay_us(100000);
+ NVIC_SystemReset(); //软复位回到bootloader
}
}
void UsartParseDataHandler(uint8_t data)
{
- if(state5V_prase_flag){//升级程序
- static UsartRecvPackState usart_receive_state = UsartReceiveWaitHead0;
- uint16_t checksum = 0;
- static uint8_t pack_datalen = 0,pack_length = 0,pack_index = 0,pack_msgtype = 0,pack_cmd = CMD_READ;
- static uint8_t index = 0;
+ if(state5V_prase_flag)
+ { //升级程序
+ static UsartRecvPackState usart_receive_state = UsartReceiveWaitHead0;
+ uint16_t checksum = 0;
+ static uint8_t pack_datalen = 0,pack_length = 0,pack_index = 0,pack_msgtype = 0,pack_cmd = CMD_READ;
+ static uint8_t index = 0;
-
- if(usart_receive_state == UsartReceiveWaitChecksum) { //若收到校验和包
- checksum = 0;
- for(int i = 0; i<pack_length-5; i++) {
- checksum += mUsartReceivePack[i];
- }
- checksum += pack_cmd;
- checksum += pack_length;
- checksum += pack_index;
- checksum += pack_datalen;
- checksum += pack_msgtype;
- if(((data + checksum)&0xff) == 0xFF) //校验通过
- {
- switch(pack_cmd)
- {
- case CMD_WRITE:
- //从mUsartReceivePack中读取pack_length长度的字节，放到全局变量中,赋值保存的参数并且存入flash
- memcpy((uint8_t*)&g_com_map + pack_index, mUsartReceivePack, pack_datalen);
- if(mUsartReceivePack[0]==1)
- UpdateProcess(pack_index);
- //返回一个error状态
- //SendComMap(pack_datalen,pack_index);
- save_com_map_to_flash();
- //delay_ms(100);
- NVIC_SystemReset();
- break;
- case CMD_READ:
- //read包中data字节，即mUsartReceivePack[0]表示数据长度；
- //从g_com_data结构体中的第index位置读取长度为mUsartReceivePack[0]的字节，发送出来
- SendComMap(pack_datalen,pack_index>>1);
- break;
- default:
- break;
- }
- }
- usart_receive_state = UsartReceiveWaitHead0;
- pack_index = 0;
- pack_length = 0;
- index=0;
- } else if((usart_receive_state == UsartReceiveWaitData) ) { //若果收到的是正常通讯包
- mUsartReceivePack[index] = data;
- index++;
- if(index == pack_length-5) { //如果收到的index与长度相等
- usart_receive_state = UsartReceiveWaitChecksum;
- }
- } else if(usart_receive_state == UsartReceiveWaitDataLen) { //收到指令类型字节
- pack_datalen = data;
- usart_receive_state = UsartReceiveWaitData;
- }else if(usart_receive_state == UsartReceiveWaitIndex) { //收到指令类型字节
- pack_index = data;
- usart_receive_state = UsartReceiveWaitDataLen;
- } else if(usart_receive_state == UsartReceiveWaitCMD) { //收到指令类型字节
- pack_cmd = data;
- usart_receive_state = UsartReceiveWaitIndex;
- } else if(usart_receive_state == UsartReceiveWaitLength) { //收到长度字节
-
- pack_length = data;
- pack_index = 0;
- usart_receive_state = UsartReceiveWaitCMD;
-
- } else if((usart_receive_state == UsartReceiveWaitHead0) && (data == 0x55)) { //收到第一个包头
- usart_receive_state = UsartReceiveWaitHead1;
- } else if((usart_receive_state == UsartReceiveWaitHead1) && (data == 0xAA)) { //收到第二个包头
- usart_receive_state = UsartReceiveWaitMsgType;
- }else if ((usart_receive_state == UsartReceiveWaitMsgType) && (data == 0x3)) {
- usart_receive_state = UsartReceiveWaitLength;
- pack_msgtype = data;
- }
- else {
- usart_receive_state = UsartReceiveWaitHead0;
- pack_index = 0;
- pack_length = 0;
- }
-}else if(gps_prase_flag){
+
+ if(usart_receive_state == UsartReceiveWaitChecksum)
+ { //若收到校验和包
+ checksum = 0;
+ for(int i = 0; i<pack_length-5; i++) {
+ checksum += mUsartReceivePack[i];
+ }
+ checksum += pack_cmd;
+ checksum += pack_length;
+ checksum += pack_index;
+ checksum += pack_datalen;
+ checksum += pack_msgtype;
+ if(((data + checksum)&0xff) == 0xFF) //校验通过
+ {
+ switch(pack_cmd)
+ {
+ case CMD_WRITE:
+ //从mUsartReceivePack中读取pack_length长度的字节，放到全局变量中,赋值保存的参数并且存入flash
+ memcpy((uint8_t*)&g_com_map + pack_index, mUsartReceivePack, pack_datalen);
+ if(mUsartReceivePack[0]==1)
+ UpdateProcess(pack_index);
+ //返回一个error状态
+ //SendComMap(pack_datalen,pack_index);
+ save_com_map_to_flash();
+ //delay_ms(100);
+ NVIC_SystemReset();
+ break;
+ case CMD_READ:
+ //read包中data字节，即mUsartReceivePack[0]表示数据长度；
+ //从g_com_data结构体中的第index位置读取长度为mUsartReceivePack[0]的字节，发送出来
+ SendComMap(pack_datalen,pack_index>>1);
+ break;
+ default:
+ break;
+ }
+ }
+ usart_receive_state = UsartReceiveWaitHead0;
+ pack_index = 0;
+ pack_length = 0;
+ index=0;
+ } else if((usart_receive_state == UsartReceiveWaitData) ) { //若果收到的是正常通讯包
+ mUsartReceivePack[index] = data;
+ index++;
+ if(index == pack_length-5) { //如果收到的index与长度相等
+ usart_receive_state = UsartReceiveWaitChecksum;
+ }
+ } else if(usart_receive_state == UsartReceiveWaitDataLen) { //收到指令类型字节
+ pack_datalen = data;
+ usart_receive_state = UsartReceiveWaitData;
+ } else if(usart_receive_state == UsartReceiveWaitIndex) { //收到指令类型字节
+ pack_index = data;
+ usart_receive_state = UsartReceiveWaitDataLen;
+ } else if(usart_receive_state == UsartReceiveWaitCMD) { //收到指令类型字节
+ pack_cmd = data;
+ usart_receive_state = UsartReceiveWaitIndex;
+ } else if(usart_receive_state == UsartReceiveWaitLength) { //收到长度字节
+
+ pack_length = data;
+ pack_index = 0;
+ usart_receive_state = UsartReceiveWaitCMD;
+
+ } else if((usart_receive_state == UsartReceiveWaitHead0) && (data == 0x55)) { //收到第一个包头
+ usart_receive_state = UsartReceiveWaitHead1;
+ } else if((usart_receive_state == UsartReceiveWaitHead1) && (data == 0xAA)) { //收到第二个包头
+ usart_receive_state = UsartReceiveWaitMsgType;
+ } else if ((usart_receive_state == UsartReceiveWaitMsgType) && (data == 0x3)) {
+ usart_receive_state = UsartReceiveWaitLength;
+ pack_msgtype = data;
+ }
+ else {
+ usart_receive_state = UsartReceiveWaitHead0;
+ pack_index = 0;
+ pack_length = 0;
+ }
+ } else if(gps_prase_flag)
+ {
//GPS解析数据
// static ST_BLERecv BLE_recvive;
- GGA_DataStruct jdrecv,wdrecv,Posstate;
- static uint8_t index = 0;
- //接收数据开始分析
- mUsart2ReceivePack[index] = data; //char数组传进来参数data
- mUsart2ReceivePack_before = mUsart2ReceivePack_now;
- mUsart2ReceivePack_now=data;
- index++;
- if( mUsart2ReceivePack_before == 0x0D && mUsart2ReceivePack_now==0x0A )//接收数据到“0x0D 0x0A”结束
- {
- //解析该条GPS报文
- analysis_num=sscanf((char*)mUsart2ReceivePack,"$%[^,],%*[^,],%[^,],%*[^,],%[^,],%*[^,],%[^,],%*[^,],%*[^,],%*[^,],%*[^,],%*[^,],%*[^,],%*[^,],%*s",gps_header,wdrecv.m_pData,jdrecv.m_pData,Posstate.m_pData);
- if(!memcmp(gps_header,"GNGGA",5)){
- wd=strtod(wdrecv.m_pData,NULL);
- jd=strtod(jdrecv.m_pData,NULL);
- pos_state=atoi(Posstate.m_pData);
- }else{
- wd=0;
- jd=0;
- }
- blink_led(&gps_success_state);
- if(pos_state!=0){
- //4g.jd=jd;
- //4g.wd=wd;
- gps_timeout_flag=1;//不超时接收状态
- gps_need_data_flag=0;//接收数据完成
- gps_wait_count=0;//清0接收状态
+ GGA_DataStruct jdrecv,wdrecv,Posstate;
+ static uint8_t index = 0;
+ //接收数据开始分析
+ mUsart2ReceivePack[index] = data; //char数组传进来参数data
+ mUsart2ReceivePack_before = mUsart2ReceivePack_now;
+ mUsart2ReceivePack_now=data;
+ index++;
+ if( mUsart2ReceivePack_before == 0x0D && mUsart2ReceivePack_now==0x0A )//接收数据到“0x0D 0x0A”结束
+ {
+ //解析该条GPS报文
+ analysis_num=sscanf((char*)mUsart2ReceivePack,"$%[^,],%*[^,],%[^,],%*[^,],%[^,],%*[^,],%[^,],%*[^,],%*[^,],%*[^,],%*[^,],%*[^,],%*[^,],%*[^,],%*s",gps_header,wdrecv.m_pData,jdrecv.m_pData,Posstate.m_pData);
+ if(!memcmp(gps_header,"GNGGA",5))
+ {
+ wd=strtod(wdrecv.m_pData,NULL);
+ jd=strtod(jdrecv.m_pData,NULL);
+ pos_state=atoi(Posstate.m_pData);
+ } else {
+ wd=0;
+ jd=0;
+ }
+ blink_led(&gps_success_state);
+ if(pos_state!=0)
+ {
+ //4g.jd=jd;
+ //4g.wd=wd;
+ gps_timeout_flag=1;//不超时接收状态
+ gps_need_data_flag=0;//接收数据完成
+ gps_wait_count=0;//清0接收状态
// gps_enable_flag=0;//收到有效数据关闭GPS
- }
- //memset(mUsart2ReceivePack,0,sizeof(mUsart2ReceivePack));
- memset(wdrecv.m_pData,0,sizeof(wdrecv.m_pData));
- memset(jdrecv.m_pData,0,sizeof(jdrecv.m_pData));
- memset(Posstate.m_pData,0,sizeof(Posstate.m_pData));
- index=0;
- mUsart2ReceivePack_before=0;
- mUsart2ReceivePack_now=0;
- }
- }
+ }
+ //memset(mUsart2ReceivePack,0,sizeof(mUsart2ReceivePack));
+ memset(wdrecv.m_pData,0,sizeof(wdrecv.m_pData));
+ memset(jdrecv.m_pData,0,sizeof(jdrecv.m_pData));
+ memset(Posstate.m_pData,0,sizeof(Posstate.m_pData));
+ index=0;
+ mUsart2ReceivePack_before=0;
+ mUsart2ReceivePack_now=0;
+ }
+ }
}
-
-void Usart2ParseDataHandler(uint8_t data)//UART蓝牙数据分析处理
-{
- //打印接收到的蓝牙模块信息
- //printf("这个是传入的数据%c",data);
-// static UsartRecvPackState usart2_receive_state = UsartReceiveWaitHead0;
- //static UsartRecvPackState usart2_receive_state = UsartReceiveWaitData;
-
- static ST_BLERecv BLE_recvive;//创建蓝牙状态结构体
-
-
- uint16_t checksum = 0;
-
- static uint8_t pack_datalen = 0,pack_length = 0,pack_index = 0,pack_msgtype = 0,pack_cmd = CMD_READ;
- static uint8_t index = 0;
-
-// uint8_t dev_id[14],dev_ssi[5],i,k=0;
-// //char char_mac[14],char_ssi[6];
-// int j=0;
-// //uint16_t temp_16,temp_16_id,temp_16_distance;
-// uint8_t temp8_H,temp8_L;
-// //float temp_float;
-// //double ssi_double;//,distance_double;
-// //int32_t distance_int;
-// uint16_t Label_id=0; //标签id
-
-
- //接收数据开始分析
- mUsart2ReceivePack[index] = data; //char数组传进来参数data
- mUsart2ReceivePack_before = mUsart2ReceivePack_now;
- mUsart2ReceivePack_now=data;
- index++;
- if( mUsart2ReceivePack_before == 0x0D && mUsart2ReceivePack_now==0x0A )//接收数据到“0x0D 0x0A”结束
- {
- mUsart2ReceivePack[index]=0;
- //printf("0D0A进入后的数据为%s到此结束",mUsart2ReceivePack);
-// if(strncmp("RF-CRAZY",(char*)mUsart2ReceivePack,8)==0)
-// {
-// BLE_recvive.m_eState=BLE_RECV_STATE_MAC;//如果为名字后判断并改为MAC接收状态
-// }
-//
- switch(BLE_recvive.m_eState)
- { case BLE_RECV_STATE_IDLE:
- if(strncmp("RF-CRAZY",(char*)mUsart2ReceivePack,8)==0)
- BLE_recvive.m_eState=BLE_RECV_STATE_MAC;//如果为名字后判断并改为MAC接收状态
- break;
- case BLE_RECV_STATE_MAC://MAC接受处理状态
- strcpy(BLE_recvive.m_macHeader,(char*)mUsart2ReceivePack+5);//复制到蓝牙结构体中,+5是为了跳过MAC字符和冒号未处理0D0A
- //处理MAC字符不让换行
- char*p=BLE_recvive.m_macHeader+strlen(BLE_recvive.m_macHeader)-2;
- *p='\0';
- //printf("处理过后的MAC为%s",BLE_recvive.m_macHeader);
- BLE_recvive.m_eState=BLE_RECV_STATE_RSSI;
- break;
- case BLE_RECV_STATE_RSSI://RSSI接收处理状态
- strcpy(BLE_recvive.m_rssiHeader2,(char*)mUsart2ReceivePack+6);//复制到蓝牙结构体中,+5是为了跳过MAC字符和冒号未处理0D0A
- //printf(" 处理过后的RSSI为%s",BLE_recvive.m_rssiHeader2);
- BLE_recvive.m_eState=BLE_RECV_STATE_IDLE;
- break;
- }
-
-// if(mUsart2ReceivePack[0] ==0x2B ) //“+”扫描到开始或结束字符串的首个字符
-// {
-// if (mUsart2ReceivePack[5] ==0x20)
-// {
-// printf("UART扫描结束 :+SCAN END\r\n"); //本次扫描结束
-// CT_sum++; //包序值
-// if(CT_sum>255) CT_sum=0;
-//
-// //发送数据缓存
-// Lora_TXD_bff[0] = 0x55;
-// Lora_TXD_bff[1] = 0xAA;
-// Lora_TXD_bff[2] = 0x12;
-// Lora_TXD_bff[3] = 8+4*numb_base; //数据长度 8+4*基站数量
-//
-// Label_id=Label_id_local; //标签id
-// memcpy(&Lora_TXD_bff[4],&Label_id ,2);
-//
-// Lora_TXD_bff[6] = CT_sum; //标签包序
-// Lora_TXD_bff[7] = 0x32; //按键/电量,测试数据50
-// Lora_TXD_bff[8] = 0; //LORA等待应答
-
-// Lora_TXD_bff[9]= numb_base; //基站数量
-
-// for(i=10;i<(10+numb_base*2);i=i+2)
-// {
-// memcpy(&Lora_TXD_bff[i+0] ,&data_buff[(i-10)/2][0] ,2); //基站ID
-// memcpy(&Lora_TXD_bff[i+numb_base*2],&data_buff[(i-10)/2][1] ,2); //基站距离
-// }
-// for( i = 2;i<(4+8+4*numb_base); i++) //去包头后 校验 累加取反
-// {
-// checksum += Lora_TXD_bff[i];
-// }
-// checksum = ~checksum;
-// memcpy(&Lora_TXD_bff[2+8+4*numb_base],&checksum ,2); //和取反 校验
-//
-// Radio_init(); //唤醒 为发送状态
-// Radio.Send( Lora_TXD_bff, (4+8+4*numb_base)); //LORA模块上传数据
-//
-
-// //基站距离 清零
-// for(i=0;i<numb_base;i++)
-// {
-// //for(k=1;k<2;k++) //清距离数据
-// for(k=0;k<2;k++) //清ID号和距离数据
-// {
-// data_buff[i][k]=0;
-// }
-// }
-// numb_base =0;
-// data_buff_start =0;
-//
-// printf("\r\n");
-// //delay_ms(5);
-// Uart2_SendString( Uart2_str); //发下一次扫描指令
-// }
-//
-// else if(mUsart2ReceivePack[5] ==0x5F) //“_"下划线
-// {
-// printf("UART扫描开始 :+SCAN_MANU:\r\n");
-// }
-// }
-// else
-// {
-// j=memcmp(id_cmpare,mUsart2ReceivePack,8); //比较目标蓝牙地址 前4个字节
-// if(j==0)//跟目标蓝牙mac地址相同
-// {
-//
-// //拷贝mac地址
-// for(i=0;i<12;i++)
-// {
-// char_mac[i] = mUsart2ReceivePack[i];
-// }
-// char_mac[12]='\0';
-//
-//
-// //拷贝信号
-// for(i=15;i<18;i++)
-// {
-// char_ssi[i-15] = mUsart2ReceivePack[i];
-// }
-// if(mUsart2ReceivePack[18]==0x0D || mUsart2ReceivePack[18]==0x20) //信号是-两位数
-// {
-// char_ssi[3]= '\0' ;
-// char_broadcast_data[0]= '\0';
-// if (mUsart2ReceivePack[18]==0x0D) //信号是-两位数，无广播内容
-// {
-// CT_satrt=0;
-// }
-// else if(mUsart2ReceivePack[18]==0x20) //信号是-两位数，有广播内容,空格后一位开始，到0x0D 结束。
-// {
-// CT_satrt=19;
-// }
-// ssi_double = -((char_ssi[1]-0x30)*10 + (char_ssi[2]-0x30)); //2位信号值int
-// }
-// else if(mUsart2ReceivePack[18]>=0x30 && mUsart2ReceivePack[18]<=0x39 ) //信号是-三位数
-// {
-// char_ssi[3]=mUsart2ReceivePack[18];
-// char_ssi[4]= '\0' ;
-// char_broadcast_data[0]= '\0';
-// if (mUsart2ReceivePack[19]==0x0D) //信号是-三位数，无广播内容
-// {
-// CT_satrt=0;
-// }
-// else if(mUsart2ReceivePack[19]==0x20) //信号是-三位数，有广播内容,空格后一位开始，到0x0D 结束。
-// {
-// CT_satrt=20;
-// }
-// ssi_double = -((char_ssi[1]-0x30)*100 + (char_ssi[2]-0x30)*10 + (char_ssi[3]-0x30));//3位信号值int
-// }
-//
-// printf("mac= %s ",char_mac);
-// printf("ssi= %s ",char_ssi);
-
-// //基站ID处理
-// temp_16_id = (char_mac[8]-0x30)*1000 + (char_mac[9]-0x30)*100 + (char_mac[10]-0x30)*10 + (char_mac[11]-0x30);
-// printf("ID = %d ",temp_16_id );
-// //基站距离处理
-// temp_16_distance = 0.003083 * exp(-0.09909*ssi_double)*100;//单位cm
-// printf("距离 = %d cm \r\n",temp_16_distance );
-
-// //比较ID号并拷贝数据到缓存区
-// for(i=0;i<data_buff_MAX;i++)
-// {
-// if(data_buff[i][0] == temp_16_id) //检测到已存ID
-// {
-// data_buff[i][1] = temp_16_distance;
-// data_buff_start=0;
-// break;
-// }
-// else if (data_buff[i][0]==0)
-// {
-// data_buff_start=i+1;
-// numb_base=data_buff_start; //拷贝扫描到基站的数量
-// break;
-// }
-// }
-// if(data_buff_start!=0)
-// {
-// data_buff[data_buff_start-1][0] = temp_16_id;
-// data_buff[data_buff_start-1][1] = temp_16_distance;
-//
-// }
-// }
-// }
- index=0;
- mUsart2ReceivePack_before=0;
- mUsart2ReceivePack_now=0;
- }
-//printf("处理过后的数组为%s\n",mUsart2ReceivePack);
-}
-
--
Gitblit v1.9.3