XRange_Tag.git - Gitblit

			@@ -30,6 +30,7 @@
			#include "beep.h"
			#include "modbus.h"

			#define USART_INTEGRATE_OUTPUT
			/------------------------------------ Marcos ------------------------------------------/
			/* Inter-ranging delay period, in milliseconds. */
			#define RNG_DELAY_MS 100
			@@ -77,7 +78,7 @@
			NEARPOLL,
			}tag_state=GETNEARMSG;
			static dwt_config_t config = {
			2, /* Channel number. */
			5, /* Channel number. */
			DWT_PRF_64M, /* Pulse repetition frequency. */
			DWT_PLEN_128, /* Preamble length. */
			DWT_PAC8, /* Preamble acquisition chunk size. Used in RX only. */
			@@ -294,6 +295,7 @@
			u8 nearbase_num=0,last_nearbase_num,next_nearbase_num,last_slotnum, para_update,para_len,stationary_flag=0;
			u32 rec_tagpos_binary;
			int16_t offset=2700;
			extern int16_t g_commap_antdelay;
			u8 motor_state,rec_remotepara_state,rec_remotepara[80];
			void NearPoll(void)
			{
			@@ -323,9 +325,10 @@
			tx_near_msg[NEARBASENUM_INDEX] = nearbase_num;
			memcpy(&tx_near_msg[NEARBASEID_INDEX],&nearbaseid_list,nearbase_num*2);
			tx_near_msg[MESSAGE_TYPE_IDX] = NEAR_POLL;
			memcpy(&tx_near_msg[NEARBASEID_INDEX+nearbase_num*4],&g_commap_antdelay,2);
			memcpy(&tx_near_msg[ANCHOR_ID_IDX],&mainbase_id,2);
			dwt_writetxdata(13+2*nearbase_num, tx_near_msg, 0);//将Poll包数据传给DW1000，将在开启发送时传出去
			dwt_writetxfctrl(13+2*nearbase_num, 0);//设置超宽带发送数据长度
			dwt_writetxdata(15+4*nearbase_num, tx_near_msg, 0);//将Poll包数据传给DW1000，将在开启发送时传出去
			dwt_writetxfctrl(15+4*nearbase_num, 0);//设置超宽带发送数据长度
			dwt_starttx(DWT_START_TX_IMMEDIATE \| DWT_RESPONSE_EXPECTED);//开启发送，发送完成后等待一段时间开启接收，等待时间在dwt_setrxaftertxdelay中设置

			tx_near_msg[TAGCONFIGSUCCESS_INDEX] =0;
			@@ -456,26 +459,7 @@
			delay_ms(100);
			}
			NVIC_SystemReset();
			}

			// count_offset=sync_count-current_count-143;
			// current_slottimes=(ancsync_time-10000)/(g_com_map[COM_INTERVAL]*1000);
			// nextpoll_delaytime=tyncpoll_time1000+g_com_map[COM_INTERVAL]1000-((ancsync_time)%(g_com_map[COM_INTERVAL]*1000))-4300;
			// if(abs(ancsync_time-910000)<1000)
			// {
			// nextpoll_delaytime+=10000;
			// }
			// if(nextpoll_delaytime<2000)
			// {
			// nextpoll_delaytime+=g_com_map[COM_INTERVAL]*1000;
			// }
			// lastpoll_count= current_count+(nextpoll_delaytime)/LPTIMER_LSB;
			// if(lastpoll_count>LPTIMER_1S_COUNT)
			// lastpoll_count-=LPTIMER_1S_COUNT;
			// __HAL_LPTIM_COMPARE_SET(&hlptim1, lastpoll_count);
			/////////////////////////////////////////
			// dwt_setdelayedtrxtime(final_tx_time);
			// result=dwt_starttx(DWT_START_TX_DELAYED);//设定为延迟发送
			}
			}else{
			rec_nearbasepos=FindNearBasePos(rec_nearbaseid);

			@@ -494,13 +478,6 @@
			if(motor_state<(rx_buffer[MOTORSTATE_INDEX]&0xf)&&(rx_buffer[MOTORSTATE_INDEX]&0xf)!=3)
			{
			motor_state=rx_buffer[MOTORSTATE_INDEX];
			}
			if(rec_remotepara_state&&!memcmp(&rx_buffer[TAG_ID_IDX],&dev_id,2))
			{
			para_update = 1;
			tx_near_msg[TAGCONFIGSUCCESS_INDEX] = 1;
			para_len = frame_len-22;
			memcpy(rec_remotepara,&rx_buffer[REMOTEPARA_INDEX],para_len);
			}
			final_msg_set_ts(&tx_near_msg[FINAL_MSG_RESP_RX_NEARBASE_IDX+(rec_nearbasepos)*4], resp_rx_ts);
			dwt_writetxdata(28+nearbase_num*4, tx_near_msg, 0);//将发送数据写入DW1000
			@@ -522,9 +499,9 @@
			}
			if(mainbase_lost_count>tag_frequency*BASELOST_STOPMOTOR_TIME)
			{motor_state=0; }
			dwt_write32bitreg(SYS_STATUS_ID,SYS_STATUS_RXFCG\| SYS_STATUS_ALL_RX_ERR);
			dwt_write32bitreg(SYS_STATUS_ID,SYS_STATUS_RXFCG\| SYS_STATUS_ALL_RX_ERR);
			nearbase_num=recbase_num;
			j=0;
			j=0;
			if(exsistbase_list[0]==0)
			{
			// u8 temp_adc,random_value;
			@@ -581,32 +558,26 @@
			{
			nearbaseid_list[i]=true_nearbase_idlist[i];
			nearbase_distlist[i]=true_nearbase_distlist[i];
			if(nearbase_distlist[i]!=0x1ffff&&true_exsistbase_list[i]==0xa)
			if(nearbase_distlist[i]!=0x1ffff&&true_exsistbase_list[i]==KEEP_TIMES)
			{
			memcpy(&usart_send[4+6*report_num],&nearbaseid_list[i],2);
			memcpy(&usart_send[6+6*report_num],&nearbase_distlist[i],4);
			report_num++;
			}
			}
			#ifdef USART_INTEGRATE_OUTPUT
			usart_send[0] = 0x55;
			usart_send[1] = 0xAA;
			usart_send[2] = 4;//正常模式
			usart_send[3] = report_num*6+2;//正常模式
			checksum = Checksum_u16(&usart_send[2],report_num*6+2);
			memcpy(&usart_send[4+report_num*6],&checksum,2);
			USART_puts(usart_send,6+report_num*6);
			#endif

			for(i=0;i<MAX_NEARBASE_NUM;i++)
			{
			nearbase_distlist[i]=0x1ffff;
			}
			if(para_update)
			{
			uint8_t pack_length = 0,pack_index = 0,pack_msgtype = 0;
			pack_msgtype = rec_remotepara[0];
			pack_index = rec_remotepara[1];
			pack_length = rec_remotepara[2];
			if(pack_msgtype==2)
			{
			memcpy((uint8_t*)&g_com_map + pack_index, &rec_remotepara[3], pack_length);
			//返回一个error状态
			//SendComMap(pack_datalen,pack_index);
			save_com_map_to_flash();
			delay_ms(100);
			NVIC_SystemReset();
			}
			}
			dwt_write32bitreg(SYS_STATUS_ID, SYS_STATUS_ALL_RX_ERR\| SYS_STATUS_TXFRS \|SYS_STATUS_RXFCG);
			HAL_GPIO_WritePin(LED0_GPIO, GPIO_PIN_9, GPIO_PIN_RESET);