UWB_SmallModule_F103.git

			@@ -128,9 +128,8 @@

			/* Configure DW1000. See NOTE 6 below. */
			dwt_configure(&config);//éç½®DW1000



			dwt_setinterrupt( DWT_INT_RFCG \| (DWT_INT_ARFE \| DWT_INT_RFSL \| DWT_INT_SFDT \| DWT_INT_RPHE \| DWT_INT_RFCE \| DWT_INT_RFTO \| DWT_INT_RXPTO), 1);

			/* Apply default antenna delay value. See NOTE 1 below. */
			dwt_setrxantennadelay(RX_ANT_DLY); //è®¾ç½®æ¥æ¶å¤©çº¿å»¶è¿
			dwt_settxantennadelay(0); //è®¾ç½®åå°å¤©çº¿å»¶è¿
			@@ -183,10 +182,11 @@
			u8 g_start_sync_flag;
			void SyncPoll(u8 sync_seq,uint32_t sync_baseid)
			{u8 result;
			g_start_sync_flag=1; //ä¸ææ¨¡å¼ï¼éåºç»ç«¯åï¼éè¦éæ°æ¥è¿
			//g_start_sync_flag=1; //ä¸ææ¨¡å¼ï¼éåºç»ç«¯åï¼éè¦éæ°æ¥è¿
			dwt_forcetrxoff(); //å³éæ¥æ¶ï¼ä»¥é²å¨RX ON ç¶æ


			tx_sync_msg[GROUP_ID_IDX] = group_id;
			tx_sync_msg[SYNC_SEQ_IDX]=sync_seq;
			memcpy(&tx_sync_msg[ANCHOR_ID_IDX],&sync_baseid,4);
			dwt_writetxdata(sizeof(tx_sync_msg), tx_sync_msg, 0);//å°Pollåæ°æ®ä¼ ç»DW1000ï¼å°å¨å¼å¯åéæ¶ä¼ åºå»
			@@ -198,6 +198,10 @@
			{ };
			}
			dwt_write32bitreg(SYS_STATUS_ID, SYS_STATUS_TXFRS);//æ¸æ¥æ å¿ä½
			// UART_CheckSend();
			//dwt_setinterrupt( DWT_INT_RFCG \| (DWT_INT_ARFE \| DWT_INT_RFSL \| DWT_INT_SFDT \| DWT_INT_RPHE \| DWT_INT_RFCE \| DWT_INT_RFTO \| DWT_INT_RXPTO), 1);
			dwt_setrxtimeout(0);//è®¾å®æ¥æ¶è¶æ¶æ¶é´ï¼0ä½æ²¡æè¶æ¶æ¶é´
			dwt_rxenable(0);//æå¼æ¥æ¶
			}
			uint16_t g_Resttimer;
			uint8_t result;
			@@ -216,13 +220,13 @@
			u16 nearbaseid_list[MAX_NEARBASE_NUM],mainbase_id,true_nearbase_idlist[MAX_NEARBASE_NUM];
			int32_t mainbase_dist,nearbase_distlist[MAX_NEARBASE_NUM],true_nearbase_distlist[MAX_NEARBASE_NUM],true_exsistbase_list[MAX_NEARBASE_NUM];
			uint8_t trygetnearmsg_times;
			u16 current_slotnum,total_slotnum,target_time,last_time;
			u16 current_slotnum,total_slotnum,target_time,last_time,record_time[10],record_i;
			u32 rec_tagpos_binary;
			extern uint32_t tagpos_binary;
			void SetNextPollTime(u16 time)
			{
			current_slotnum++;
			if(current_slotnum==total_slotnum)
			if(current_slotnum>=total_slotnum)
			current_slotnum-=total_slotnum;
			//time=5;
			target_time=((current_slotnum*g_com_map[COM_INTERVAL])+time);
			@@ -239,7 +243,11 @@
			{target_time-=1000;}
			if(target_time<0)
			{target_time+=1000;}

			record_time[record_i++]=target_time;
			if(record_i>=10)
			{
			record_i=0;
			}
			}
			u8 FindNearBasePos(u16 baseid)
			{
			@@ -422,7 +430,7 @@
			memcpy(&tmp_time,&rx_buffer[ANCTIMEUS],2);


			if(g_com_map[DEV_ROLE]!=0)
			//if(g_com_map[DEV_ROLE]!=0)
			{
			sync_timer=temp_sync_timer1;
			//// memcpy(&tagslotpos,&rx_buffer[TAGSLOTPOS],2);
			@@ -465,10 +473,10 @@
			dwt_writetxdata(28+nearbase_num*4, tx_nearfinal_msg, 0);//å°åéæ°æ®åå¥DW1000
			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)
			if(temp_dist!=0x1ffff)
			{
			g_Resttimer=0;
			IWDG_Feed();
			IWDG_Feed();
			#ifdef USART_SINGLE_OUTPUT
			usart_send[2] = 1;//æ£å¸¸æ¨¡å¼
			usart_send[3] = 17;//æ°æ®æ®µé¿åº¦
			@@ -486,6 +494,7 @@
			usart_send[14] = button;
			checksum = Checksum_u16(&usart_send[2],17);
			memcpy(&usart_send[19],&checksum,2);
			if(g_com_map[MODBUS_MODE]!=1)
			UART_PushFrame(usart_send,21);
			#endif

			@@ -517,7 +526,7 @@
			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;//æ£å¸¸æ¨¡å¼
			@@ -536,6 +545,7 @@
			usart_send[14] = button;
			checksum = Checksum_u16(&usart_send[2],17);
			memcpy(&usart_send[19],&checksum,2);
			if(g_com_map[MODBUS_MODE]!=1)
			UART_PushFrame(usart_send,21);
			#endif

			@@ -717,6 +727,7 @@
			{
			//LED0_ON;
			dwt_forcetrxoff();
			dwt_setinterrupt(DWT_INT_TFRS \| DWT_INT_RFCG \| (DWT_INT_ARFE \| DWT_INT_RFSL \| DWT_INT_SFDT \| DWT_INT_RPHE \| DWT_INT_RFCE \| DWT_INT_RFTO \| DWT_INT_RXPTO), 0);
			GPIO_WriteBit(GPIOA, GPIO_Pin_10, Bit_SET);
			switch(tag_state)
			{
			@@ -734,12 +745,16 @@
			SetNextPollTime(tyncpoll_time);
			g_start_send_flag = 0;
			GPIO_WriteBit(GPIOA, GPIO_Pin_10, Bit_RESET);
			UART_CheckSend();
			dwt_setinterrupt( DWT_INT_RFCG \| (DWT_INT_ARFE \| DWT_INT_RFSL \| DWT_INT_SFDT \| DWT_INT_RPHE \| DWT_INT_RFCE \| DWT_INT_RFTO \| DWT_INT_RXPTO), 1);
			dwt_setrxtimeout(0);//è®¾å®æ¥æ¶è¶æ¶æ¶é´ï¼0ä½æ²¡æè¶æ¶æ¶é´
			dwt_rxenable(0);//æå¼æ¥æ¶
			}

			int8_t correction_time,new_tagid=0;
			extern uint8_t sync_seq;
			u16 taglist_num=0,taglist_pos;
			u16 tagid_list[TAG_NUM_IN_SYS];
			u16 tagid_list[TAG_NUM_IN_SYS],tagstate_list[TAG_NUM_IN_SYS];
			u8 tagofflinetime[TAG_NUM_IN_SYS];
			int32_t tagdist_list[TAG_NUM_IN_SYS];
			void TagListUpdate(void)
			@@ -863,6 +878,8 @@
			// min_power = - 10 * log10((F1 F1 + F2 F2 + F3 * F3) / (C *B));
			return min_power;
			}
			u8 testt[100],testt2[100],testt3[100],testt4[100],testt6[100],ti;
			u16 testt5[100];
			u16 smallcar_idlist[10]={0x4052,0x4032,0x4055,0x4034,0x4016,0x4010,0x4036,0x4027,0x4024,0x4047};
			extern u16 dist_threshold;
			u8 misdist_num[TAG_NUM_IN_SYS],seize_anchor,getrange_success=0;
			@@ -917,11 +934,11 @@
			dwt_writetxfctrl(22, 0);//è®¾å®åéé¿åº¦
			}
			result = dwt_starttx(DWT_START_TX_DELAYED \| DWT_RESPONSE_EXPECTED);//å»¶è¿åéï¼çå¾æ¥æ¶

			testt2[ti]=frame_seq_nb2;

			if(result==0)
			{
			while (!((status_reg = dwt_read32bitreg(SYS_STATUS_ID)) & (SYS_STATUS_RXFCG \| SYS_STATUS_ALL_RX_ERR))&&!g_start_sync_flag)///ä¸ææ¥è¯¢è¯çç¶æç´å°æ¥æ¶æåæèåºç°éè¯¯
			while (!((status_reg = dwt_read32bitreg(SYS_STATUS_ID)) & (SYS_STATUS_RXFCG \| SYS_STATUS_ALL_RX_ERR)))///ä¸ææ¥è¯¢è¯çç¶æç´å°æ¥æ¶æåæèåºç°éè¯¯
			{ };
			}else{
			result++;
			@@ -929,7 +946,7 @@

			if (status_reg & SYS_STATUS_RXFCG)//æ¥æ¶æå
			{

			testt3[ti]=frame_seq_nb2;
			dwt_write32bitreg(SYS_STATUS_ID, SYS_STATUS_RXFCG \| SYS_STATUS_TXFRS);//æ¸æ¥æ å¿ä½
			frame_len = dwt_read32bitreg(RX_FINFO_ID) & RX_FINFO_RXFLEN_MASK;//æ°æ®é¿åº¦
			dwt_readrxdata(rx_buffer, frame_len, 0);//è¯»åæ¥æ¶æ°æ®
			@@ -978,11 +995,12 @@
			}

			g_flag_Taggetdist[taglist_pos]=0;

			testt4[ti]=frame_seq_nb2;
			testt5[ti] = hex_dist/10;
			if(hex_dist>-100000&&hex_dist<2000000)
			{
			if(abs(hex_dist-his_dist[taglist_pos])<dist_threshold\|\|misdist_num[taglist_pos]>3)
			{
			{u8 i=0;

			g_Resttimer=0;
			IWDG_Feed();
			@@ -1018,15 +1036,42 @@
			usart_send[16] = rx_power;
			checksum = Checksum_u16(&usart_send[2],17);
			memcpy(&usart_send[19],&checksum,2);
			if(g_com_map[MODBUS_MODE]!=1)
			UART_PushFrame(usart_send,21);
			//USART_puts(usart_send,21);
			testt6[ti]=frame_seq_nb2;
			tagstate_list[taglist_pos] = button<<8\|battary;
			#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);
			anc_report_num++;
			#endif
			Modbus_HoldReg[taglist_pos*4] = tag_id_recv;
			Modbus_HoldReg[taglist_pos*4+1] = button<<8\|battary;
			memcpy(&Modbus_HoldReg[taglist_pos*4+2],&tagdist_list[taglist_pos],4);
			for(i=0;i<taglist_num-1;i++)
			{
			if( tagdist_list[i]>tagdist_list[i+1]&&tagdist_list[i+1]!=0)
			{
			int32_t tempdist;
			u16 tempid,tempstate;
			tempdist = tagdist_list[i];
			tempid = tagid_list[i];
			tempstate = tagstate_list[i];

			tagdist_list[i] = tagdist_list[i+1];
			tagid_list[i] = tagid_list[i+1];
			tagstate_list[i] = tagstate_list[i+1];

			tagdist_list[i+1] = tempdist;
			tagid_list[i+1] = tempid;
			tagstate_list[i+1] = tempstate;
			}
			}
			for(i=0;i<taglist_num;i++)
			{
			Modbus_HoldReg[i*4] = tagid_list[i];
			Modbus_HoldReg[i*4+1] = tagstate_list[i];
			memcpy(&Modbus_HoldReg[i*4+2],&tagdist_list[i],4);
			}

			}else{
			// printf("%d",hex_dist);
			misdist_num[taglist_pos]++;
			@@ -1042,6 +1087,20 @@
			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_Start(void)
			{

			dwt_write32bitreg(SYS_STATUS_ID, SYS_STATUS_ALL_RX_ERR\| SYS_STATUS_TXFRS \|SYS_STATUS_RXFCG);
			g_start_sync_flag=0;
			dwt_setinterrupt(DWT_INT_TFRS \| DWT_INT_RFCG \| (DWT_INT_ARFE \| DWT_INT_RFSL \| DWT_INT_SFDT \| DWT_INT_RPHE \| DWT_INT_RFCE \| DWT_INT_RFTO \| DWT_INT_RXPTO), 1);
			dwt_setrxtimeout(0);//è®¾å®æ¥æ¶è¶æ¶æ¶é´ï¼0ä½æ²¡æè¶æ¶æ¶é´
			dwt_rxenable(0);//æå¼æ¥æ¶
			// while (!((status_reg = dwt_read32bitreg(SYS_STATUS_ID)) & (SYS_STATUS_RXFCG \| SYS_STATUS_ALL_RX_ERR))&&!g_start_send_flag&&!g_start_sync_flag)//ä¸ææ¥è¯¢è¯çç¶æç´å°æ¥æ¶æåæèåºç°éè¯¯
			// {
			// //IdleTask();
			// };
			}

			void Anchor_App(void)
			{

			@@ -1049,23 +1108,24 @@
			u16 tempid;
			uint32_t rec_syncid;

			dwt_write32bitreg(SYS_STATUS_ID, SYS_STATUS_ALL_RX_ERR\| SYS_STATUS_TXFRS \|SYS_STATUS_RXFCG);
			g_start_sync_flag=0;
			// dwt_write32bitreg(SYS_STATUS_ID, SYS_STATUS_ALL_RX_ERR\| SYS_STATUS_TXFRS \|SYS_STATUS_RXFCG);
			// g_start_sync_flag=0;

			dwt_setrxtimeout(0);//è®¾å®æ¥æ¶è¶æ¶æ¶é´ï¼0ä½æ²¡æè¶æ¶æ¶é´
			dwt_rxenable(0);//æå¼æ¥æ¶
			// GPIO_WriteBit(GPIOA, GPIO_Pin_10, Bit_SET);
			while (!((status_reg = dwt_read32bitreg(SYS_STATUS_ID)) & (SYS_STATUS_RXFCG \| SYS_STATUS_ALL_RX_ERR))&&!g_start_send_flag&&!g_start_sync_flag)//ä¸ææ¥è¯¢è¯çç¶æç´å°æ¥æ¶æåæèåºç°éè¯¯
			{

			IdleTask();
			};
			// dwt_setrxtimeout(0);//è®¾å®æ¥æ¶è¶æ¶æ¶é´ï¼0ä½æ²¡æè¶æ¶æ¶é´
			// dwt_rxenable(0);//æå¼æ¥æ¶
			//// GPIO_WriteBit(GPIOA, GPIO_Pin_10, Bit_SET);
			// while (!((status_reg = dwt_read32bitreg(SYS_STATUS_ID)) & (SYS_STATUS_RXFCG \| SYS_STATUS_ALL_RX_ERR))&&!g_start_send_flag&&!g_start_sync_flag)//ä¸ææ¥è¯¢è¯çç¶æç´å°æ¥æ¶æåæèåºç°éè¯¯
			// {
			//
			// IdleTask();
			// };
			dwt_setinterrupt(DWT_INT_RFCG \| (DWT_INT_ARFE \| DWT_INT_RFSL \| DWT_INT_SFDT \| DWT_INT_RPHE \| DWT_INT_RFCE \| DWT_INT_RFTO \| DWT_INT_RXPTO), 0);
			status_reg = dwt_read32bitreg(SYS_STATUS_ID);
			//GPIO_WriteBit(GPIOA, GPIO_Pin_10, Bit_RESET);
			if (status_reg & SYS_STATUS_RXFCG)//æåæ¥æ¶
			{ u16 tag_recv_interval;
			float temp_tagpos;



			dwt_write32bitreg(SYS_STATUS_ID, SYS_STATUS_RXFCG);//æ¸é¤æ å¿ä½
			frame_len = dwt_read32bitreg(RX_FINFO_ID) & RX_FINFO_RXFL_MASK_1023;//è·å¾æ¥æ¶æ°æ®é¿åº¦
			recpoll_len = frame_len;
			@@ -1124,10 +1184,13 @@

			case NEAR_POLL:
			frame_seq_nb2 = rx_buffer[SEQUENCE_IDX];
			testt[ti++]=frame_seq_nb2;
			if(ti>100)
			ti=0;
			battary = rx_buffer[BATTARY_IDX];
			button = rx_buffer[BUTTON_IDX];
			rec_nearbase_num=rx_buffer[NEARBASENUM_INDEX];
			memcpy(&tag_id_recv,&rx_buffer[TAG_ID_IDX],2);
			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);
			@@ -1151,8 +1214,7 @@
			if(taglist_pos==taglist_num)
			{
			taglist_pos=taglist_num;
			tagid_list[taglist_num++]=tag_id_recv;

			tagid_list[taglist_num++]=tag_id_recv;
			new_tagid=1;
			}else{
			new_tagid=0;
			@@ -1187,9 +1249,13 @@

			break;
			}
			}else{
			}
			}else{
			dwt_write32bitreg(SYS_STATUS_ID, SYS_STATUS_ALL_RX_ERR);
			}
			}
			UART_CheckSend();
			dwt_setinterrupt( DWT_INT_RFCG \| (DWT_INT_ARFE \| DWT_INT_RFSL \| DWT_INT_SFDT \| DWT_INT_RPHE \| DWT_INT_RFCE \| DWT_INT_RFTO \| DWT_INT_RXPTO), 1);
			dwt_setrxtimeout(0);//è®¾å®æ¥æ¶è¶æ¶æ¶é´ï¼0ä½æ²¡æè¶æ¶æ¶é´
			dwt_rxenable(0);//æå¼æ¥æ¶
			}