UWB_SmallModule_F103.git

			@@ -1,5 +1,6 @@
			#include "dw_app.h"
			#include "ADC.h"
			#include "stm32f10x_it.h"
			#define TDFILTER
			enum enumtagstate
			{
			@@ -315,10 +316,10 @@
			}
			u8 test=0;
			u8 anclost_times=0;
			u8 exsistbase_list[MAX_NEARBASE_NUM],report_num,get_newbase=0;
			u8 exsistbase_list[MAX_NEARBASE_NUM],report_num,get_newbase=0,uwbrec_userdata[20],uwbrec_userdatalen;
			u16 temp_sync_timer1,temp_sync_timer2;

			void NearPoll(void)
			extern u8 usartrec_userdatalen,heartbeat_timer;
			void NearPoll(void)
			{
			static u8 mainbase_lost_count=0,flag_finalsend,flag_rxon;
			uint32_t temp1,temp2,dw_systime;
			@@ -344,20 +345,23 @@
			tx_nearpoll_msg[BUTTON_IDX] = !READ_KEY0;
			tx_nearpoll_msg[SEQUENCE_IDX] = frame_seq_nb++;
			tx_nearpoll_msg[NEARBASENUM_INDEX] = nearbase_num;
			memcpy(&tx_nearpoll_msg[NEARBASEID_INDEX],&nearbaseid_list,nearbase_num*2);
			tx_nearpoll_msg[MESSAGE_TYPE_IDX] = NEAR_POLL;
			memcpy(&tx_nearpoll_msg[ANCHOR_ID_IDX],&mainbase_id,2);
			tx_nearpoll_msg[POLL_USERDATA_IDX] = usartrec_userdatalen;
			memcpy(&tx_nearpoll_msg[POLL_USERDATA_IDX+1],&uartrec_userdata,usartrec_userdatalen);
			memcpy(&tx_nearpoll_msg[NEARBASEID_INDEX],&nearbaseid_list,nearbase_num*2);
			for(i=0;i<nearbase_num;i++)
			{ memcpy(&tx_nearpoll_msg[NEARBASEID_INDEX+nearbase_num2+i2],&nearbase_distlist[i],2);}

			memcpy(&tx_nearpoll_msg[NEARBASEID_INDEX+nearbase_num*4],&g_commap_antdelay,2);
			memcpy(&tx_nearpoll_msg[KUIXIANLEN_INDEX],&g_commap_antdelay,2);

			for(i=0;i<MAX_NEARBASE_NUM;i++)
			{
			nearbase_distlist[i]=0x1ffff;
			}
			tx_nearpoll_msg[MESSAGE_TYPE_IDX] = NEAR_POLL;
			memcpy(&tx_nearpoll_msg[ANCHOR_ID_IDX],&mainbase_id,2);
			dwt_writetxdata(15+4*nearbase_num, tx_nearpoll_msg, 0);//å°Pollåæ°æ®ä¼ ç»DW1000ï¼å°å¨å¼å¯åéæ¶ä¼ åºå»
			dwt_writetxfctrl(15+4*nearbase_num, 0);//è®¾ç½®è¶å®½å¸¦åéæ°æ®é¿åº¦

			dwt_writetxdata(27+4*nearbase_num, tx_nearpoll_msg, 0);//å°Pollåæ°æ®ä¼ ç»DW1000ï¼å°å¨å¼å¯åéæ¶ä¼ åºå»
			dwt_writetxfctrl(27+4*nearbase_num, 0);//è®¾ç½®è¶å®½å¸¦åéæ°æ®é¿åº¦
			dwt_starttx(DWT_START_TX_IMMEDIATE \| DWT_RESPONSE_EXPECTED);//å¼å¯åéï¼åéå®æåçå¾ä¸æ®µæ¶é´å¼å¯æ¥æ¶ï¼çå¾æ¶é´å¨dwt_setrxaftertxdelayä¸è®¾ç½®

			flag_finalsend=0;
			@@ -421,22 +425,22 @@
			memcpy(&tmp_time,&rx_buffer[ANCTIMEUS],2);


			if(g_com_map[DEV_ROLE]!=0)
			{
			sync_timer=temp_sync_timer1;
			//// memcpy(&tagslotpos,&rx_buffer[TAGSLOTPOS],2);
			// if(g_com_map[DEV_ROLE]!=0)
			// {
			// sync_timer=temp_sync_timer1;
			////// memcpy(&tagslotpos,&rx_buffer[TAGSLOTPOS],2);
			////
			//

			tmp_time=tmp_time+650;
			if(tmp_time>999)
			{
			tmp_time-=999;
			sync_timer++;
			if(sync_timer>=1000)
			{sync_timer=0;}
			}
			TIM3->CNT=tmp_time;
			}
			// tmp_time=tmp_time+650;
			// if(tmp_time>999)
			// {
			// tmp_time-=999;
			// sync_timer++;
			// if(sync_timer>=1000)
			// {sync_timer=0;}
			// }
			// TIM3->CNT=tmp_time;
			// }
			current_slotnum=temp_sync_timer1/g_com_map[COM_INTERVAL];
			// if(tagslotpos>max_slotpos)
			// tagslotpos=tagslotpos%(max_slotpos+1);
			@@ -462,30 +466,35 @@
			tx_nearfinal_msg[MESSAGE_TYPE_IDX]=NEAR_FINAL;
			tx_nearfinal_msg[GROUP_ID_IDX] = group_id;
			dwt_writetxdata(28+nearbase_num*4, tx_nearfinal_msg, 0);//å°åéæ°æ®åå¥DW1000
			dwt_writetxfctrl(28+nearbase_num*4, 0);//è®¾å®åéæ°æ®é¿åº¦
			dwt_writetxfctrl(28+nearbase_num*4, 0);// è®¾å®åéæ°æ®é¿åº¦
			memcpy(&rec_tagpos_binary,&rx_buffer[NEARMSG_EMPTYSLOTPOS_INDEX],4);
			if(temp_dist!=0x1ffff&&g_com_map[ALARM_DISTANCE1] == 1)
			ClearUWBUserData();
			uwbrec_userdatalen = rx_buffer[RESPONSE_USERDATA_IDX];
			if(uwbrec_userdatalen<=USERDATA_MAXLEN)
			{
			memcpy(uwbrec_userdata,&rx_buffer[RESPONSE_USERDATA_IDX+1],uwbrec_userdatalen);
			}
			if(temp_dist!=0x1ffff )
			{
			g_Resttimer=0;
			IWDG_Feed();
			#ifdef USART_SINGLE_OUTPUT
			usart_send[2] = 1;//æ£å¸¸æ¨¡å¼
			usart_send[3] = 17;//æ°æ®æ®µé¿åº¦
			usart_send[3] = 29;//æ°æ®æ®µé¿åº¦
			usart_send[4] = frame_seq_nb;//æ°æ®æ®µé¿åº¦
			if(g_com_map[DEV_ROLE])
			{

			memcpy(&usart_send[5],&dev_id,2);
			memcpy(&usart_send[7],&rec_nearbaseid,2);
			}else{
			memcpy(&usart_send[5],&rec_nearbaseid,2);
			memcpy(&usart_send[7],&dev_id,2);
			}

			memcpy(&usart_send[9],&rx_buffer[DIST_IDX],4);
			usart_send[13] = battary;
			usart_send[14] = button;
			checksum = Checksum_u16(&usart_send[2],17);
			memcpy(&usart_send[19],&checksum,2);
			UART_PushFrame(usart_send,21);
			memcpy(&usart_send[17],selftest,2);
			memcpy(&usart_send[21],uwbrec_userdata,10);
			checksum = Checksum_u16(&usart_send[2],29);
			memcpy(&usart_send[31],&checksum,2);
			UART_PushFrame(usart_send,33);
			heartbeat_timer = 0;
			#endif

			//dwt_setdelayedtrxtime(final_tx_time);//è®¾ç½®finalååéæ¶é´T5
			@@ -506,6 +515,12 @@

			memcpy(&temp_dist,&rx_buffer[DIST_IDX],4);
			nearbase_distlist[rec_nearbasepos]=temp_dist;
			ClearUWBUserData();
			uwbrec_userdatalen = rx_buffer[RESPONSE_USERDATA_IDX];
			if(uwbrec_userdatalen<=USERDATA_MAXLEN)
			{
			memcpy(uwbrec_userdata,&rx_buffer[RESPONSE_USERDATA_IDX+1],uwbrec_userdatalen);
			}

			if(temp_dist!=0x1ffff)
			exsistbase_list[rec_nearbasepos]=KEEP_TIMES;
			@@ -516,26 +531,25 @@
			LED0_BLINK;
			// memcpy(&rec_tagpos_binary,&rx_buffer[NEARMSG_EMPTYSLOTPOS_INDEX],4);
			// tagslotpos=GetRandomSlotPos(rec_tagpos_binary);
			if(temp_dist!=0x1ffff&&g_com_map[ALARM_DISTANCE1] == 1)
			if(temp_dist!=0x1ffff )
			{
			#ifdef USART_SINGLE_OUTPUT
			usart_send[2] = 1;//æ£å¸¸æ¨¡å¼
			usart_send[3] = 17;//æ°æ®æ®µé¿åº¦
			usart_send[3] = 29;//æ°æ®æ®µé¿åº¦
			usart_send[4] = frame_seq_nb;//æ°æ®æ®µé¿åº¦
			if(g_com_map[DEV_ROLE])
			{

			memcpy(&usart_send[5],&dev_id,2);
			memcpy(&usart_send[7],&rec_nearbaseid,2);
			}else{
			memcpy(&usart_send[5],&rec_nearbaseid,2);
			memcpy(&usart_send[7],&dev_id,2);
			}

			memcpy(&usart_send[9],&rx_buffer[DIST_IDX],4);
			usart_send[13] = battary;
			usart_send[14] = button;
			checksum = Checksum_u16(&usart_send[2],17);
			memcpy(&usart_send[19],&checksum,2);
			UART_PushFrame(usart_send,21);
			memcpy(&usart_send[17],selftest,2);
			memcpy(&usart_send[21],uwbrec_userdata,10);
			checksum = Checksum_u16(&usart_send[2],29);
			memcpy(&usart_send[31],&checksum,2);
			UART_PushFrame(usart_send,33);
			heartbeat_timer = 0;
			#endif

			//dwt_setdelayedtrxtime(final_tx_time);//è®¾ç½®finalååéæ¶é´T5
			@@ -571,9 +585,10 @@
			// temp_adc=Get_ADC_Value();
			// random_value=random_value\|((temp_adc&0x01)<<i);
			// }
			pollsendtimer+=time32_incr%11;
			tagslotpos=GetRandomSlotPos(rec_tagpos_binary\|tagpos_binary);
			tyncpoll_time = (tagslotpos--%max_slotpos)*slottime;
			tag_state=NEARPOLL;
			tag_state=NEARPOLL;
			}
			// tyncpoll_time=0;
			next_nearbase_num=0;
			@@ -868,9 +883,11 @@
			u8 misdist_num[TAG_NUM_IN_SYS],seize_anchor,getrange_success=0;
			int32_t filter_dist,filter_speed;
			u8 newmeasure,recpoll_len;
			u8 motorstate=0;
			u8 tagpos_rec[50],tagpos_send[50],ancidlist_num;
			u8 Anchor_RecNearPoll(u8 ancrec_nearbasepos) //0 mainbase 1 first near_base
			{
			u8 motorstate;

			tmp_time=TIM3->CNT;
			memcpy(&tx_nearresp_msg[ANCTIMEMS],&sync_timer,2);
			memcpy(&tx_nearresp_msg[ANCTIMEUS],&tmp_time,2);
			@@ -913,14 +930,18 @@
			tx_nearresp_msg[MESSAGE_TYPE_IDX]=NEAR_RESPONSE;
			tx_nearresp_msg[MOTORSTATE_INDEX]=motorstate;//(remotesend_state<<4)\|motorstate;
			tx_nearresp_msg[MOTORSTATE_INDEX]&=0x0f;
			if(usartrec_userdatalen<=USERDATA_MAXLEN)
			{tx_nearresp_msg[RESPONSE_USERDATA_IDX] = usartrec_userdatalen;
			memcpy(&tx_nearresp_msg[RESPONSE_USERDATA_IDX+1],uartrec_userdata,usartrec_userdatalen);
			}
			// if(remotesend_state)
			// {
			// memcpy(&tx_nearresp_msg[REMOTEPARA_INDEX],remotetag_para,REMOTEPARA_LEN);
			// dwt_writetxdata(22+REMOTEPARA_LEN, tx_nearresp_msg, 0);//åå¥åéæ°æ®
			// dwt_writetxfctrl(22+REMOTEPARA_LEN, 0);//è®¾å®åéé¿åº¦
			// }else{
			dwt_writetxdata(24, tx_nearresp_msg, 0);//åå¥åéæ°æ®
			dwt_writetxfctrl(24, 0);//è®¾å®åéé¿åº¦
			dwt_writetxdata(24+11, tx_nearresp_msg, 0);//åå¥åéæ°æ®
			dwt_writetxfctrl(24+11, 0);//è®¾å®åéé¿åº¦
			// }
			result = dwt_starttx(DWT_START_TX_DELAYED \| DWT_RESPONSE_EXPECTED);//å»¶è¿åéï¼çå¾æ¥æ¶

			@@ -1017,7 +1038,7 @@
			}
			#ifdef USART_SINGLE_OUTPUT
			usart_send[2] = 1;//æ£å¸¸æ¨¡å¼
			usart_send[3] = 17;//æ°æ®æ®µé¿åº¦
			usart_send[3] = 29;//æ°æ®æ®µé¿åº¦
			usart_send[4] = frame_seq_nb2;//æ°æ®æ®µé¿åº¦
			memcpy(&usart_send[5],&tag_id_recv,2);
			memcpy(&usart_send[7],&dev_id,2);
			@@ -1028,11 +1049,12 @@
			usart_send[14] = button;
			usart_send[15] = firstpath_power;
			usart_send[16] = rx_power;
			memcpy(&usart_send[19],selftest,2);
			memcpy(&usart_send[21],uartrec_userdata,10);
			memcpy(&usart_send[17],selftest,2);
			memcpy(&usart_send[21],uwbrec_userdata,10);
			checksum = Checksum_u16(&usart_send[2],29);
			memcpy(&usart_send[31],&checksum,2);
			UART_PushFrame(usart_send,33);
			heartbeat_timer = 0;
			#else
			memcpy(&usart_send_anc[4+6*anc_report_num],&tag_id_recv,2);
			memcpy(&usart_send_anc[6+6*anc_report_num],&tagdist_list[taglist_pos],4);
			@@ -1051,7 +1073,7 @@
			}
			uint32_t current_syncid=0xffffffff,synclost_timer;
			extern u8 flag_syncbase;
			u8 tagpos_rec[50],tagpos_send[50],ancidlist_num;

			u16 ancidlist_rec[20],ancidlist_send[20],rec_ancidlist[20],rec_ancdistlist[20];
			void Anchor_App(void)
			{
			@@ -1141,7 +1163,11 @@
			memcpy(&tag_id_recv,&rx_buffer[TAG_ID_IDX],2);
			memcpy(&rec_ancidlist,&rx_buffer[NEARBASEID_INDEX],2*rec_nearbase_num);
			memcpy(&rec_ancdistlist,&rx_buffer[NEARBASEID_INDEX+2rec_nearbase_num],2rec_nearbase_num);
			memcpy(&rec_antdelay,&rx_buffer[NEARBASEID_INDEX+nearbase_num*4],2);
			memcpy(&rec_antdelay,&rx_buffer[KUIXIANLEN_INDEX],2);
			ClearUWBUserData();
			uwbrec_userdatalen = rx_buffer[POLL_USERDATA_IDX];
			if(uwbrec_userdatalen<=20)
			memcpy(uwbrec_userdata,&rx_buffer[POLL_USERDATA_IDX+1],uwbrec_userdatalen);
			#ifdef USART_ALL_OUTPUT
			usart_send[2] = 0x0c;//æ£å¸¸æ¨¡å¼
			usart_send[3] = 8+rec_nearbase_num*4;//æ°æ®æ®µé¿åº¦