| | |
| | | // change_base_count=0; |
| | | // } |
| | | //} |
| | | uint8_t GetRandomValue(void) |
| | | { |
| | | uint8_t random_value=0,temp_adc,i; |
| | | for(i=0;i<8;i++) |
| | | { |
| | | temp_adc=Get_ADC_Value(); |
| | | random_value=random_value|((temp_adc&0x01)<<i); |
| | | } |
| | | return random_value; |
| | | } |
| | | u8 GetRandomSlotPos(uint32_t emptyslot) |
| | | { |
| | | u8 i; |
| | | for(i=dev_id%32;i<max_slotpos;i++) |
| | | u8 i,temp_value; |
| | | temp_value = GetRandomValue(); |
| | | for(i=temp_value%32;i<max_slotpos;i++) |
| | | { |
| | | if(((emptyslot>>i)&0x1)==0) |
| | | { |
| | |
| | | tx_nearfinal_msg[MESSAGE_TYPE_IDX]=NEAR_FINAL; |
| | | 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); |
| | | tagslotpos=GetRandomSlotPos(rec_tagpos_binary); |
| | | |
| | | |
| | | if(temp_dist!=0x1ffff) |
| | | { |
| | |
| | | dwt_writetxdata(28+nearbase_num*4, tx_nearfinal_msg, 0);//å°åéæ°æ®åå
¥DW1000 |
| | | dwt_writetxfctrl(28+nearbase_num*4, 0);//设å®åéæ°æ®é¿åº¦ |
| | | LED0_BLINK; |
| | | // memcpy(&rec_tagpos_binary,&rx_buffer[NEARMSG_EMPTYSLOTPOS_INDEX],4); |
| | | // tagslotpos=GetRandomSlotPos(rec_tagpos_binary); |
| | | if(temp_dist!=0x1ffff) |
| | | { |
| | | #ifndef USART_INTEGRATE_OUTPUT |
| | |
| | | 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(); |
| | | g_Resttimer=0; |
| | | }; |
| | | |
| | | if (status_reg & SYS_STATUS_RXFCG)//æåæ¥æ¶ |
| | | { u16 tag_recv_interval; |
| | | float temp_tagpos; |
| | | |
| | | g_Resttimer=0; |
| | | dwt_write32bitreg(SYS_STATUS_ID, SYS_STATUS_RXFCG);//æ¸
餿 å¿ä½ |
| | | frame_len = dwt_read32bitreg(RX_FINFO_ID) & RX_FINFO_RXFL_MASK_1023;//è·å¾æ¥æ¶æ°æ®é¿åº¦ |
| | | dwt_readrxdata(rx_buffer, frame_len, 0);//è¯»åæ¥æ¶æ°æ® |