| | |
| | | dwt_writetxfctrl(sizeof(tx_final_msg), 0);//设å®åéæ°æ®é¿åº¦ |
| | | dwt_starttx(DWT_START_TX_DELAYED);//设å®ä¸ºå»¶è¿åé |
| | | |
| | | //è¿é为串å£è¾åº |
| | | // if (GPIO_ReadInputDataBit(GPIOA, SW2) != RESET) //éè¿æ¨ç å¼å
³å¤ææ°æ®è¾åºæ ¼å¼ |
| | | // { |
| | | // dID = TAG_ID; |
| | | // printf("TAG_ID: %2.0f ", dID); |
| | | // dID = ANCHOR_ID; |
| | | // printf("ANCHOR_ID: %2.0f ", dID); |
| | | // printf("Distance: %5.0f cm\n", (double)dist[TAG_ID]); |
| | | // } |
| | | // else |
| | | // { |
| | | // send[2] = ANCHOR_ID; |
| | | // send[3] = TAG_ID; |
| | | |
| | | // memcpy(&send[4], &dist[TAG_ID], 2); |
| | | // check = Checksum_u16(&send[2], 6); |
| | | // memcpy(&send[8], &check, 2); |
| | | // USART_puts(send, 10); |
| | | // } |
| | | |
| | | /* Poll DW1000 until TX frame sent event set. See NOTE 8 below. */ |
| | | while (!(dwt_read32bitreg(SYS_STATUS_ID) & SYS_STATUS_TXFRS))//䏿æ¥è¯¢è¯çç¶æç´å°åé宿 |
| | | { }; |
| | |
| | | // dist[TAG_ID] = LP(dis, TAG_ID); //LP 为ä½é滤波å¨ï¼è®©æ°æ®æ´ç¨³å® |
| | | |
| | | LED0_BLINK; //æ¯æå䏿¬¡é讯åéªç䏿¬¡ |
| | | //è¿éä¾ä¸²å£è¾åº |
| | | // if (GPIO_ReadInputDataBit(GPIOA, SW2) != RESET) //éè¿æ¨ç å¼å
³å¤ææ°æ®è¾åºæ ¼å¼ |
| | | // { |
| | | // dID = TAG_ID; |
| | | // printf("TAG_ID: %2.0f ", dID); |
| | | // dID = ANCHOR_ID; |
| | | // printf("ANCHOR_ID: %2.0f ", dID); |
| | | // printf("Distance: %5.0f cm\n", (double)dist[TAG_ID]); |
| | | // } |
| | | // else |
| | | // { |
| | | // send[2] = ANCHOR_ID; |
| | | // send[3] = TAG_ID; |
| | | |
| | | // memcpy(&send[4], &dist[TAG_ID], 2); |
| | | // check = Checksum_u16(&send[2], 6); |
| | | // memcpy(&send[8], &check, 2); |
| | | // USART_puts(send, 10); |
| | | // } |
| | | |
| | | } |
| | | } |