#include #include "stm32f4xx_hal.h" #include "filters.h" #include "ADC.h" #include "deca_device_api.h" #include "deca_regs.h" #include "dw_driver.h" #include "Spi.h" #include "led.h" #include "serial_at_cmd_app.h" #include "Usart.h" #include "global_param.h" #include "filters.h" #include #include "beep.h" #include #include "TrackingDiff.h" #include "Uart.h" #include "DBG.h" #include "AppConfig.h" #include "SPIFlash.h" #include #define PACKET_SEQNO_INDEX (1) #define PACKET_SEQNO_COMP_INDEX (2) #define PACKET_HEADER (3) #define PACKET_TRAILER (2) #define PACKET_OVERHEAD (PACKET_HEADER + PACKET_TRAILER) #define PACKET_SIZE (96) //#define PACKET_1K_SIZE (1024) //#define FILE_NAME_LENGTH APP_CONFIG_UWB_YMODEM_SPIFLASH_NAMEADDRESS-APP_CONFIG_UWB_YMODEM_SPIFLASH_NAMESIZEADDRESS #define FILE_NAME_LENGTH 256 #define FILE_SIZE_LENGTH (16) #define SOH (0x01) /* start of 128-byte data packet */ #define STX (0x02) /* start of 1024-byte data packet */ #define EOT (0x04) /* end of transmission */ #define ACK (0x06) /* acknowledge */ #define NAK (0x15) /* negative acknowledge */ #define CA (0x18) /* two of these in succession aborts transfer */ #define CRC16 (0x43) /* 'C' == 0x43, request 16-bit CRC */ //#define ABORT1 (0x41) /* 'A' == 0x41, abort by user */ //#define ABORT2 (0x61) /* 'a' == 0x61, abort by user */ //#define NAK_TIMEOUT (0x100000) #define MAX_ERRORS (20) //#define ADDR_FLASH_SECTOR_2 ((HIDO_UINT32)0x08008000) u8 send_len,i,rx_buffer[200]; #define UPDATE_MSGTYPE 0x30 #define ANCHOR_ID_IDX 1 #define TAG_ID_IDX 5 int uwb_successful_flag=0; int flag_uwbwaitprocess=0; u8 m=1; extern u16 packsize; uint8_t UWB_uchCRCHi = 0xFF; uint8_t UWB_uchCRCLo = 0xFF; const uint8_t UWB_auchCRCHi[] = { 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40}; const uint8_t UWB_auchCRCLo[] = { 0x00, 0xC0, 0xC1, 0x01, 0xC3, 0x03, 0x02, 0xC2, 0xC6, 0x06, 0x07, 0xC7, 0x05, 0xC5, 0xC4, 0x04, 0xCC, 0x0C, 0x0D, 0xCD, 0x0F, 0xCF, 0xCE, 0x0E, 0x0A, 0xCA, 0xCB, 0x0B, 0xC9, 0x09, 0x08, 0xC8, 0xD8, 0x18, 0x19, 0xD9, 0x1B, 0xDB, 0xDA, 0x1A, 0x1E, 0xDE, 0xDF, 0x1F, 0xDD, 0x1D, 0x1C, 0xDC, 0x14, 0xD4, 0xD5, 0x15, 0xD7, 0x17, 0x16, 0xD6, 0xD2, 0x12, 0x13, 0xD3, 0x11, 0xD1, 0xD0, 0x10, 0xF0, 0x30, 0x31, 0xF1, 0x33, 0xF3, 0xF2, 0x32, 0x36, 0xF6, 0xF7, 0x37, 0xF5, 0x35, 0x34, 0xF4, 0x3C, 0xFC, 0xFD, 0x3D, 0xFF, 0x3F, 0x3E, 0xFE, 0xFA, 0x3A, 0x3B, 0xFB, 0x39, 0xF9, 0xF8, 0x38, 0x28, 0xE8, 0xE9, 0x29, 0xEB, 0x2B, 0x2A, 0xEA, 0xEE, 0x2E, 0x2F, 0xEF, 0x2D, 0xED, 0xEC, 0x2C, 0xE4, 0x24, 0x25, 0xE5, 0x27, 0xE7, 0xE6, 0x26, 0x22, 0xE2, 0xE3, 0x23, 0xE1, 0x21, 0x20, 0xE0, 0xA0, 0x60, 0x61, 0xA1, 0x63, 0xA3, 0xA2, 0x62, 0x66, 0xA6, 0xA7, 0x67, 0xA5, 0x65, 0x64, 0xA4, 0x6C, 0xAC, 0xAD, 0x6D, 0xAF, 0x6F, 0x6E, 0xAE, 0xAA, 0x6A, 0x6B, 0xAB, 0x69, 0xA9, 0xA8, 0x68, 0x78, 0xB8, 0xB9, 0x79, 0xBB, 0x7B, 0x7A, 0xBA, 0xBE, 0x7E, 0x7F, 0xBF, 0x7D, 0xBD, 0xBC, 0x7C, 0xB4, 0x74, 0x75, 0xB5, 0x77, 0xB7, 0xB6, 0x76, 0x72, 0xB2, 0xB3, 0x73, 0xB1, 0x71, 0x70, 0xB0, 0x50, 0x90, 0x91, 0x51, 0x93, 0x53, 0x52, 0x92, 0x96, 0x56, 0x57, 0x97, 0x55, 0x95, 0x94, 0x54, 0x9C, 0x5C, 0x5D, 0x9D, 0x5F, 0x9F, 0x9E, 0x5E, 0x5A, 0x9A, 0x9B, 0x5B, 0x99, 0x59, 0x58, 0x98, 0x88, 0x48, 0x49, 0x89, 0x4B, 0x8B, 0x8A, 0x4A, 0x4E, 0x8E, 0x8F, 0x4F, 0x8D, 0x4D, 0x4C, 0x8C, 0x44, 0x84, 0x85, 0x45, 0x87, 0x47, 0x46, 0x86, 0x82, 0x42, 0x43, 0x83, 0x41, 0x81, 0x80, 0x40}; void UWB_CRC_Compute(uint8_t *puchMsg, uint16_t usDataLen) { uint32_t uIndex; while (usDataLen--) { uIndex = UWB_uchCRCHi ^ *puchMsg++; UWB_uchCRCHi = UWB_uchCRCLo ^ UWB_auchCRCHi[uIndex]; UWB_uchCRCLo = UWB_auchCRCLo[uIndex]; } // return ((uchCRCHi << 8) | (uchCRCLo)); } /** * @brief Update CRC16 for input byte * @param CRC input value * @param input byte * @retval Updated CRC value */ static uint8_t uwb_keydata; uint32_t uwbKeyPressed(uint8_t *key) { if(uwb_successful_flag==1) { *key = uwb_keydata; uwb_successful_flag=0; return 1; } else { return 0; } } static int32_t uwb_Receive_Byte (uint8_t *c, uint32_t timeout) { while (timeout-- > 0) { if (uwbKeyPressed(c) == 1) { return 0; } Internet_Poll(); HIDO_ATLitePoll(); } return -1; } static int32_t uwb_Receive_Byte1 (uint8_t *c, uint32_t timeout) { while (timeout-- > 0) { // Internet_Poll(); // HIDO_ATLitePoll(); // APLPollTask(); if (uwbKeyPressed(c) == 1) { return 0; } } return -1; } uint16_t UpdateCRC16(uint16_t crcIn, uint8_t byte) { uint32_t crc = crcIn; uint32_t in = byte|0x100; do { crc <<= 1; in <<= 1; if(in&0x100) { ++crc; } if(crc&0x10000) { crc ^= 0x1021; } } while(!(in&0x10000)); return (crc&0xffffu); } /** * @brief Cal CRC16 for YModem Packet * @param data * @param length * @retval CRC value */ uint16_t Cal_CRC16(const uint8_t* data, uint32_t size) { uint32_t crc = 0; const uint8_t* dataEnd = data+size; while(data= PACKET_1K_SIZE ? PACKET_1K_SIZE : PACKET_SIZE; packetSize =PACKET_SIZE; size = sizeBlk < packetSize ? sizeBlk :packetSize; // if (packetSize == PACKET_1K_SIZE) // { // data[0] = STX; // } // else // { data[0] = SOH; // } data[1] = pktNo; data[2] = (~pktNo); // file_ptr = SourceBuf; // /* Filename packet has valid data */ // for (i = PACKET_HEADER; i < size + PACKET_HEADER;i++) // { // data[i] = *file_ptr++; // } if ( size < packetSize) { for (i = size + PACKET_HEADER+1; i < packetSize + PACKET_HEADER; i++) { data[i] = 0x1A; /* EOF (0x1A) or 0x00 */ } printf("Êý¾Ý°ü%d²»×ã100λ²¹³ä0x1A\n\r",m); for( j=0;j<=200;j++) printf("×îºóÒ»°üÄÚÈÝΪ£º%lx, %d\n",data[j],j ); } } uint8_t errors2 = 0; uint8_t ackReceived = 0; uint16_t blkNumber; char temp_arr[256]; u16 temp_arr_len; uint8_t Ymodem_Transmit (uint8_t *buf, const uint8_t* sendFileName, uint32_t sizeFile) { static uint8_t packet_data[PACKET_SIZE + PACKET_OVERHEAD]; static uint8_t FileName[FILE_NAME_LENGTH]; u8 debug[226][2]={0x00,0x00,0xda,0x52,0xa0,0xd6,0x7a,0x95,0xf8,0x8e,0xc1,0x88,0x4f,0xef,0xb0,0x42,0x72,0x83,0xc0,0xb6,0x97,0x32,0xd6,0x54,0xf9,0x69,0xdb,0x64,0x83,0xc3,0x8d,0x51,0xdf,0xbe,0xa5,0xa9,0xa8,0xe,0x75,0x6f,0xb6,0x6,0xa2,0x92,0x95,0x8b,0x94,0xb2,0xdb,0x46,0x59,0x7c,0xbd,0xc9,0xd0,0x8a,0xb0,0x1d,0x2c,0xc4,0x85,0xc2,0x19,0xa,0x5c,0xcf,0x96,0xf9,0x8d,0x73,0x93,0x9f,0x20,0x6e,0x83,0x6f,0x67,0x9c,0xd4,0x2c,0x22,0x7d,0x1f,0x44,0xc7,0x20,0xd3,0x5d,0xa8,0x50,0x2f,0x10,0x98,0x84,0x8e,0xd0,0x3e,0xe8,0xae,0xf,0x7d,0x41,0x4f,0xe5,0x9f,0x53,0x57,0x21,0x8f,0x16,0xb9,0xc8,0x75,0xb6,0x63,0x4c,0x1b,0xec,0x39,0x7,0xd9,0x17,0xe3,0xc4,0xd8,0x45,0x68,0xd8,0xa2,0x8a,0xdd,0xeb,0x26,0x35,0x9b,0xd3,0x3b,0x1e,0x2d,0x69,0x2,0xdb,0x88,0x19,0xdf,0xdc,0xa0,0x6f,0x1a,0x1c,0xe9,0x3b,0x6d,0x82,0x8b,0xbc,0x75,0x43,0x93,0x23,0x40,0x12,0xc1,0x73,0x1,0xa7,0xcb,0x49,0x71,0xec,0xd7,0xb,0xf6,0xf2,0x15,0x8c,0x99,0x53,0x99,0xd0,0x2b,0x49,0xd3,0xcc,0xee,0x9b,0x4b,0x1a,0x1c,0x1c,0xa8,0x4e,0x48,0x66,0x21,0xb5,0xe5,0xdd,0x52,0x6c,0xdc,0x79,0xc2,0xed,0x61,0xce,0xbb,0xdf,0x94,0xab,0xa4,0x85,0x32,0x8f,0x24,0xf6,0xa6,0x15,0xac,0xb0,0x8f,0xf6,0x97,0x8a,0x36,0x1,0x7,0x89,0x81,0x70,0xc8,0xc1,0x4d,0xb,0x73,0x1f,0x7d,0x5c,0x20,0xa9,0xbc,0x28,0x4,0xae,0x53,0x8d,0xf3,0xd5,0x93,0x3a,0xad,0xf5,0xeb,0x9f,0x56,0x8f,0xed,0x6a,0x56,0x17,0x70,0xe6,0xaa,0xf3,0x73,0x7f,0xee,0x9f,0x2d,0x2f,0x6f,0x86,0x33,0xff,0xf5,0x40,0x45,0x35,0xef,0x16,0xf5,0x7e,0x22,0x15,0x9a,0x0,0xbe,0xd,0x4c,0xa9,0x13,0xf4,0x1e,0x1d,0x7c,0xa6,0x47,0xb7,0xd2,0x44,0xa8,0x1a,0x6d,0xde,0xc4,0x4f,0xe1,0x10,0x8d,0xb6,0x45,0x14,0xdc,0x9,0x75,0x66,0x5c,0xb4,0xd8,0x31,0x7a,0xc8,0xa3,0x46,0xae,0xd,0xd4,0xf0,0xaf,0x5c,0x70,0x16,0x9c,0x22,0xff,0xf5,0x7f,0xdc,0x43,0x57,0xef,0x70,0x6b,0x12,0x92,0x3e,0x33,0xef,0xcd,0xcf,0x20,0xa4,0x9c,0x5b,0x18,0x70,0xdf,0xf1,0x53,0x24,0xd6,0x3,0xb4,0x92,0xa,0xa5,0x56,0x68,0x52,0xf4,0xcb,0xe,0xfc,0xc7,0xb5,0x9e,0xfc,0x99,0x7d,0xa7,0xb0,0x1d,0x32,0xdc,0x8d,0x22,0xcd,0x16,0x4e,0xa,0xfe,0xfd,0xd,0x39,0x8f,0xe4,0xc7,0x8d,0x13,0xda,0xa4,0x69,0x68,0x3d,0x56,0xac,0x19,0x24,0x94,0x5f,0x77,0x58,0x69,0x37,0xea,0xc,0xb5,0x4a,0x6d,0x8,0xce,0xc5,0x76,0xc1,0x2d,0xd,0x51,0x38,0x2c,0xe4,0x69,0x71,0xfd,0xa9,0x44,0x7,0xa1,0x71,0x4f,0xdc,0x29,0xfc,0x7a,0xd,0x2d,0x64,0xb1,0xb2,0x6f,0xa0,0x16,0x65}; uint8_t *buf_ptr, tempCheckSum ; uint16_t tempCRC; uint8_t receivedC[2], CRC16_F = 0, i; uint32_t size = 0, pktSize; uint8_t uwbsend[11]={0,}; m=1; errors2 = 0; u8 bagnum=0; // errors = 0; //°ÑÃû×Ö¸øµ½FileName // for (i = 0; i < (FILE_NAME_LENGTH - 1); i++) // { // FileName[i] = sendFileName[i]; // } bagnum=sizeFile/96; FLASH_Read(0x08008100+0x1e, &FileName[0],256);//ÄÃÎļþÃû³Æ CRC16_F = 1; /* Prepare first block */ Ymodem_PrepareIntialPacket(&packet_data[0], FileName, &sizeFile); //УÑéλ´¦Àí /* Send CRC or Check Sum based on CRC16_F */ if (CRC16_F) { tempCRC = Cal_CRC16(&packet_data[3], PACKET_SIZE); packet_data[PACKET_SIZE + PACKET_HEADER]=(tempCRC >> 8); packet_data[PACKET_SIZE + PACKET_HEADER+1]=(tempCRC & 0xFF); } else { tempCheckSum = CalChecksum (&packet_data[3], PACKET_SIZE); packet_data[PACKET_SIZE + PACKET_HEADER]=(tempCheckSum); } printf("Ê×°ü´ò°üÍê³É\n\r"); //¿ªÊ¼·¢Ê×°ü do { /* Send Packet */ uwbYModem_send(packet_data, PACKET_SIZE + PACKET_HEADER+2); printf("·¢Ê×°ü\n\r"); memset(temp_arr,0,sizeof(temp_arr)); temp_arr_len = sprintf(temp_arr,"·¢Ê×°ü\n\r"); UDPClient_Uploadhex(temp_arr,temp_arr_len); // for( m=0;m<=200;m++) // printf("Ê×°üÄÚÈÝΪ£º%lx, %d\n",packet_data[i],i ); // printf("·¢ËÍ"); /* Wait for Ack and 'C' */ // printf("µÈ´ý»Ø¸´ACK\n\r"); if(uwb_Receive_Byte(&receivedC[0], 0x88888) == 0) { if (receivedC[0] == ACK) { /* Packet transfered correctly */ ackReceived = 1; printf("ÊÕµ½Ê×°üACK»Ø¸´\n\r"); memset(temp_arr,0,sizeof(temp_arr)); temp_arr_len = sprintf(temp_arr,"ÊÕµ½Ê×°üACK»Ø¸´\n\r"); UDPClient_Uploadhex(temp_arr,temp_arr_len); } } else { errors2++; printf("ûÓÐÊÕµ½Ê×°üACK»Ø¸´£¬errors=%d\n\r",errors2); if(errors2==5||errors2==10||errors2==15||errors2==20) { Dw1000_Init(); } } }while (!ackReceived && (errors2 < MAX_ERRORS));//УÑé´íÎóÖØ·¢£¬Ð£Ñé´íÎó¾ÍÖØ·¢ if (errors2 >= MAX_ERRORS) { return errors2; printf("Ê×°üerrorsÂúÁË£¬Í˳ö³ÌÐò\n\r"); } printf("Ê×°ü´«Êä½áÊø£¬¿ªÊ¼´«Êý¾Ý°ü%d\n\r",m); UWB_uchCRCHi = 0xFF; UWB_uchCRCLo = 0xFF; //°ÑÊ×µØÖ·¸øËü buf_ptr = buf; //°ÑµØÖ·´óС¸øËü size = sizeFile; blkNumber = 0x01; uint16_t ym_datapack_num = 0; int q=1; /* Here 1024 bytes package is used to send the packets */ while (size) { // static uint16_t ym_datapack_num = 0; FLASH_Read((0x08008000+0x300)+PACKET_SIZE*(ym_datapack_num++),&packet_data[3],PACKET_SIZE); /* Prepare next packet ×¼±¸Êý¾ÝÖ¡ Ê×µØÖ· ´æÊý¾ÝµÄµØ·½ ÐòºÅ µØÖ·´óС*/ Ymodem_PreparePacket(buf_ptr, &packet_data[0], blkNumber, size); ackReceived = 0; receivedC[0]= 0; errors2 = 0; if (CRC16_F) { tempCRC = Cal_CRC16(&packet_data[3], PACKET_SIZE); packet_data[PACKET_SIZE + PACKET_HEADER]=(tempCRC >> 8); packet_data[PACKET_SIZE + PACKET_HEADER+1]=(tempCRC & 0xFF); } else { tempCheckSum = CalChecksum (&packet_data[3], PACKET_SIZE); packet_data[PACKET_SIZE + PACKET_HEADER]=tempCheckSum ; } UWB_CRC_Compute(packet_data+3, PACKET_SIZE); // if( debug[q][0]!=uchCRCHi) // { printf("debug\n\r");} // if( debug[q][1]!=uchCRCLo) // { printf("debug\n\r");} // q++; printf("UWB_uchCRCHi=%lx\n\r",UWB_uchCRCHi); printf("UWB_uchCRCLo=%lx\n\r",UWB_uchCRCLo); printf("ym_datapack_num=%d\n\r",ym_datapack_num); // printf("Êý¾Ý°ü%d´ò°üÍê³É£¬×¼±¸·¢°ü,ÄÚÈÝΪ£º\n\r",m); // for( q=0;q<=104;q++) // {printf("%lx, %d\n",packet_data[q],q);} do { /* Send next packet */ // if (size >= PACKET_1K_SIZE) // { // pktSize = PACKET_1K_SIZE; // // } // else // { pktSize = PACKET_SIZE; // } uwbYModem_send(packet_data, pktSize + PACKET_HEADER+2); printf("·¢°ü%d\n\r",m); memset(temp_arr,0,sizeof(temp_arr)); temp_arr_len = sprintf(temp_arr,"Éý¼¶½ø¶È°Ù·ÖÖ®%d\n\r",(int)100*m/bagnum); // Internet_Poll(); // HIDO_ATLitePoll(); // APLPollTask(); UDPClient_Uploadhex(temp_arr,temp_arr_len); // UDPClient_UploadGPS(temp_arr); // Socket_Send(0, (HIDO_UINT8 *)temp_arr, temp_arr_len); /* Wait for Ack */ // printf("µÈ´ý»Ø¸´ACK\n\r"); if ((uwb_Receive_Byte(&receivedC[0], 0x44444) == 0) && (receivedC[0] == ACK)) { ackReceived = 1; printf("ÊÕµ½Êý¾Ý°ü%dµÄACK»Ø¸´\n\r",m); m++; if (size > pktSize) { // buf_ptr += pktSize; size -= pktSize; // if (blkNumber == (APP_CONFIG_UWB_YMODEM_SPIFLASH_SIZE/1024)) // { // return 0xFF; /* error */ // printf("ÐòºÅÔö³¤´íÎó\n\r"); // } // else // { blkNumber++; printf("ÐòºÅ+1Ϊ%d\n\r",blkNumber); // } } else { // buf_ptr += pktSize; size = 0; printf("Êý¾Ý°ü%dûÊý¾ÝÁË£¬Êý¾Ý°ü´«ÊäÍê³É\n\r",m); } } else { errors2++; printf("ûÓÐÊÕµ½Êý¾Ý°ü%dACK»Ø¸´£¬errors=%d\n\r",m,errors2); if(errors2==5||errors2==10||errors2==15||errors2==20) { Dw1000_Init(); } } }while(!ackReceived && (errors2 < MAX_ERRORS));//УÑé´íÎóÖØ·¢£¬Ð£Ñé´íÎó¾ÍÖØ·¢ /* Resend packet if NAK for a count of 10 else end of commuincation */ if (errors2 >= MAX_ERRORS) { ym_datapack_num=0; UWB_uchCRCHi = 0xFF; UWB_uchCRCLo = 0xFF; printf("Êý¾Ý°ü%d errorsÂúÁË£¬Í˳ö³ÌÐò\n\r",m); return errors2; } } printf("Êý¾Ý°ü%d´«Êä½áÊø£¬¿ªÊ¼´«EOT\n\r",m); ym_datapack_num=0; ackReceived = 0; receivedC[0] = 0x00; receivedC[1] = 0x00; errors2 = 0; do { // uwbsend[0]=EOT; // uwbYModem_send(&uwbsend[0],1); //·¢ËÍÎļþÊý¾ÝÍê³Éºó£¬·¢ËÍeot±íʾÎļþ·¢ËÍÍê³É uwbsend[1]=ANCHOR_ID_IDX; uwbsend[5]=TAG_ID_IDX; uwbsend[9]=UPDATE_MSGTYPE; uwbsend[10]=EOT; dwt_forcetrxoff(); // for( i=0;i<=200;i++) // {printf("%lx, %d\n",data[i],i);} dwt_writetxdata(1+12 ,uwbsend , 0);//½«Poll°üÊý¾Ý´«¸øDW1000£¬½«ÔÚ¿ªÆô·¢ËÍʱ´«³öÈ¥ dwt_writetxfctrl(1+12, 0);//ÉèÖó¬¿í´ø·¢ËÍÊý¾Ý³¤¶È dwt_starttx(DWT_START_TX_IMMEDIATE);//¿ªÆô·¢ËͲ¢ÇÒ·¢ËÍºó¿ªÆô½ÓÊÕ£¬²¢É趨ÑÓ³Ùʱ¼ä while (!(dwt_read32bitreg(SYS_STATUS_ID) & SYS_STATUS_TXFRS))//²»¶Ï²éѯоƬ״ֱ̬µ½·¢ËÍÍê³É { }; 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); printf("·¢ËÍEOT°ü\n\r"); memset(temp_arr,0,sizeof(temp_arr)); temp_arr_len = sprintf(temp_arr,"·¢ËÍEOT°ü\n\r"); UDPClient_Uploadhex(temp_arr,temp_arr_len); /* Wait for Ack */ // receivedC[0] = (uint16_t)(USART1->RDR & (uint16_t)0x01FF); if((uwb_Receive_Byte(&receivedC[0], 0x88888) == 0) && receivedC[0] == ACK) //µÈ´ýackÓ¦´ð { ackReceived = 1; printf("ÊÕµ½EOTµÄACK\n\r"); } else { errors2++; printf("ûÓÐÊÕµ½EOT°üµÄACK»Ø¸´£¬errors=%d\n\r",errors2); if(errors2==5||errors2==10||errors2==15||errors2==20) { Dw1000_Init(); } } /* Clear Overrun flag of the USART2 */ // __HAL_UART_CLEAR_OREFLAG(&huart1); // USART_ClearFlag(USART1, UART_FLAG_ORE); }while (!ackReceived && (errors2 < MAX_ERRORS)); //ûÓÐÏìÓ¦ÖØ·¢ if (errors2 >= MAX_ERRORS) { return errors2; printf("EOT°üµÄerrorsÂúÁË£¬Í˳ö³ÌÐò"); } printf("EOT°ü´«Êä½áÊø£¬¿ªÊ¼´«Î²°ü\n\r"); /* Last packet preparation */ //·¢ËÍ×îºóÒ»°üÊý¾ÝÄÚÈÝȫΪ0µÄ×îºó°ü ¿ªÊ¼Ðźţ¨SOH£©+ ÐòºÅ + ²¹Âë + 96¸ö0 + CRCУÑ飨2×Ö½Ú£© ackReceived = 0; receivedC[0] = 0x00; receivedC[1] = 0x00; errors2 = 0; packet_data[0] = SOH; packet_data[1] = 0; packet_data [2] = 0xFF; for (i = PACKET_HEADER; i < (PACKET_SIZE + PACKET_HEADER); i++) { packet_data [i] = 0x00; } packet_data [4]=UWB_uchCRCHi; packet_data [5]=UWB_uchCRCLo; /* + CRC or Check Sum based on CRC16_F */ tempCRC = Cal_CRC16(&packet_data[3], PACKET_SIZE); packet_data[PACKET_SIZE + PACKET_HEADER]=(tempCRC >> 8); packet_data[PACKET_SIZE + PACKET_HEADER+1]=(tempCRC & 0xFF); do { /* Send Packet */ // Ymodem_SendPacket(packet_data, PACKET_SIZE + PACKET_HEADER+2); uwbYModem_send(packet_data, PACKET_SIZE + PACKET_HEADER+2); printf("·¢ËÍβ°ü\n\r"); memset(temp_arr,0,sizeof(temp_arr)); temp_arr_len = sprintf(temp_arr,"·¢ËÍβ°ü\n\r"); UDPClient_Uploadhex(temp_arr,temp_arr_len); /* Wait for Ack and 'C' */ if(uwb_Receive_Byte(&receivedC[1], 0x88888) == 0) { if (receivedC[1] == ACK) //µÈ´ýÓ¦´ð { /* Packet transfered correctly */ ackReceived = 1; printf("ÊÕµ½Î²°üµÄACK\n\r"); } } else { errors2++; printf("ûÓÐÊÕµ½Î²°üµÄACK»Ø¸´£¬errors=%d\n\r",errors2); if(errors2==5||errors2==10||errors2==15||errors2==20) { Dw1000_Init(); } } }while (!ackReceived && (errors2 < MAX_ERRORS)); /* Resend packet if NAK for a count of 10 else end of commuincation */ if (errors2 >= MAX_ERRORS) { // return errors2; printf("β°üµÄerrorsÂúÁË£¬Í˳ö³ÌÐò,µ«ÊÇ·¢ËÍÁËβ°ü£¬ËãÊdzɹ¦"); printf("β°ü´«Êä½áÊø£¬´«Êä³É¹¦\n\r"); memset(temp_arr,0,sizeof(temp_arr)); temp_arr_len = sprintf(temp_arr,"β°ü´«Êä½áÊø£¬´«Êä³É¹¦\n\r"); UDPClient_Uploadhex(temp_arr,temp_arr_len); } printf("β°ü´«Êä½áÊø£¬´«Êä³É¹¦\n\r"); memset(temp_arr,0,sizeof(temp_arr)); temp_arr_len = sprintf(temp_arr,"β°ü´«Êä½áÊø£¬´«Êä³É¹¦\n\r"); UDPClient_Uploadhex(temp_arr,temp_arr_len); printf("UWB_uchCRCHi=%lx\n\r",UWB_uchCRCHi); printf("UWB_uchCRCLo=%lx\n\r",UWB_uchCRCLo); UWB_uchCRCHi=0; UWB_uchCRCLo=0; // int z=1; // for(z=1;z<227;z++) // { // printf("0x%lx,",debug[z][0]); // printf("0x%lx,",debug[z][1]); // } // receivedC[0] = 0x00; // do // { // Send_Byte(EOT); // /* Send (EOT); */ // /* Wait for Ack */ // if ((Receive_Byte(&receivedC[0], 1000000) == 0) && receivedC[0] == ACK) // { // ackReceived = 1; // } // // else // { // errors++; // } // /* Clear Overrun flag of the USART2 */ // __HAL_UART_CLEAR_OREFLAG(&huart1); // }while (!ackReceived && (errors < 0x0A)); // // if (errors >= 0x0A) // { // return errors; // } return 0; /* file trasmitted successfully */ } /* 0x08008000 binÎļþÃû³Æ³¤¶È £¨£© 0x08008100 binÎļþÃû³Æ £¨4GÉý¼¶Ê±»á»ñµÃ£© 0x08008200 binÎļþÄÚÈݳ¤¶È 0x08008300 binÎļþÄÚÈÝ */ extern u8 flag_ancupd_start; uint8_t errorr=0; void UWB_ymodem_Upload(void) { uint8_t status = 0 ; uint8_t receivedd[1]; while(1) { printf("start\n\r"); printf("µÈC\n\r"); if(uwb_Receive_Byte1(&receivedd[0], 0x100000) == 0) { if (receivedd[0] == CRC16) { receivedd[0]=0; printf("ÊÕµ½CÁË\n\r"); /* Transmit the flash image through ymodem protocol */ memcpy(&packsize,(HIDO_VOID *)0x8008200,2);//´ÓÄÚ´æÄÃÎļþ´óС status = Ymodem_Transmit((uint8_t*)APP_CONFIG_UWB_YMODEM_SPIFLASH_SIZEADDRESS, (const uint8_t*)APP_CONFIG_UWB_YMODEM_SPIFLASH_NAMEADDRESS,packsize); if (status != 0) { // SerialPutString("\n\rError Occurred while Transmitting File\n\r"); printf("chuanshushibai\n\r"); // flag_ancupd_start = 0; } else { // SerialPutString("\n\rFile uploaded successfully \n\r"); printf("´«Êä³É¹¦\n\r"); memset(temp_arr,0,sizeof(temp_arr)); temp_arr_len = sprintf(temp_arr,"´«Êä³É¹¦\n\r"); UDPClient_Uploadhex(temp_arr,temp_arr_len); flag_ancupd_start = 0; NVIC_SystemReset(); // Dw1000_Init(); break; } } } else { errorr++; printf("chuanshushibai\n\r"); } if(errorr==10) { Dw1000_Init(); } if(errorr==15) { errorr=0; // flag_ancupd_start = 0; } } } //void SPI_FLASH_WRITE_TEXT(void) //{ // u16 o; // u16 i,temp_arr_len; // u8 write_data[256]; // char temp_arr[100]; // u8 write_name[]={0x55,0x53,0x54,0x42,0x5F,0x56,0x33,0x5F,0x31,0x2E,0x30,0x2E,0x31,0x2E,0x32,0x36,0x5F,0x4E,0x4D,0x45,0x41,0x2E,0x42,0x69,0x6E }; // for(o=0;o<=255;o++) // { write_data[o]=0x31;} //// temp_arr_len = sprintf(temp_arr,"Ãâ²¼Ïß»ùÕ¾V1.38-6.5G.Bin"); // //SPIFlash_Write(SPI_FLASH_ID_0,APP_CONFIG_UWB_YMODEM_SPIFLASH_NAMEADDRESS,write_name,sizeof(write_name)); //printf("%d\n",sizeof(write_name)); //SPIFlash_Write(SPI_FLASH_ID_0,APP_CONFIG_UWB_YMODEM_SPIFLASH_DATAADDRESS+0x1000,write_data,sizeof(write_data)); //printf("%d\n",sizeof(write_data)); //u8 text_log_data[256]; //u8 text_log_name[256]; //SPIFlash_Read(SPI_FLASH_ID_0,&text_log_data[0], APP_CONFIG_UWB_YMODEM_SPIFLASH_DATAADDRESS+0x1000,256); //SPIFlash_Read(SPI_FLASH_ID_0,&text_log_name[0], APP_CONFIG_UWB_YMODEM_SPIFLASH_NAMEADDRESS,100); // for( i=0;i<=255;i++) // {printf("%lx, %d\n",text_log_data[i],i);} // for( i=0;i<=255;i++) // {printf("%lx, %d\n",text_log_name[i],i);} //} // u8 text_log_name[2048]={0}; // u8 write_data[2048]; // u16 o; //u16 pack2048_num=0; // u16 temp_arr_len; //void SPI_FLASH_WRITE_ceshi(void) //{ //// u8 write_name[]={}; // char temp_arr[256]; // temp_arr_len = sprintf(temp_arr,"Ãâ²¼Ïß»ùÕ¾V1.42-4G.Bin"); //// for( i=0;i<=2047;i++) //// {printf("%lx, %d\n",write_data[i],i);} //// for( i=0;i<=temp_arr_len;i++) //// {printf("%lx, %d\n",temp_arr[i],i);} // SPIFlash_Erase(SPI_FLASH_ID_0,APP_CONFIG_UWB_YMODEM_SPIFLASH_NAMEADDRESS, 256, SPI_FLASH_SECTOR_ERASE_MODE_4K); // SPIFlash_Write(SPI_FLASH_ID_0,APP_CONFIG_UWB_YMODEM_SPIFLASH_NAMEADDRESS,temp_arr,temp_arr_len ); //// SPIFlash_Read(SPI_FLASH_ID_0,&text_log_name[0], APP_CONFIG_UWB_YMODEM_SPIFLASH_NAMEADDRESS,temp_arr_len); //// for( i=0;i<=temp_arr_len;i++) //// {printf("%lx, %d\n",text_log_name[i],i);} //while(packsize>=0x800) // { // FLASH_Read( 0x8008000+(2048* pack2048_num), &write_data[0], 0x800); // SPIFlash_Erase(SPI_FLASH_ID_0,APP_CONFIG_UWB_YMODEM_SPIFLASH_DATAADDRESS+0x800* pack2048_num, 0x800, SPI_FLASH_SECTOR_ERASE_MODE_4K); // SPIFlash_Write(SPI_FLASH_ID_0,APP_CONFIG_UWB_YMODEM_SPIFLASH_DATAADDRESS+0x800* pack2048_num,write_data, 0x800 ); //// SPIFlash_Read(SPI_FLASH_ID_0,&text_log_name[0], APP_CONFIG_UWB_YMODEM_SPIFLASH_DATAADDRESS+0x800* pack2048_num,0x800); // packsize = packsize-0x800; // pack2048_num++; // } // if(packsize<0x800) // { // FLASH_Read( 0x8008000+(0x800* pack2048_num), &write_data[0], packsize+1); // SPIFlash_Erase(SPI_FLASH_ID_0,APP_CONFIG_UWB_YMODEM_SPIFLASH_DATAADDRESS+0x800* pack2048_num, packsize+1, SPI_FLASH_SECTOR_ERASE_MODE_4K); // SPIFlash_Write(SPI_FLASH_ID_0,APP_CONFIG_UWB_YMODEM_SPIFLASH_DATAADDRESS+0x800* pack2048_num,write_data, packsize+1 ); // } // pack2048_num=0; //} //void FLASH_WRITE_name(void) //{ // char temp_arr[256]={0,}; // temp_arr_len = sprintf(temp_arr,"Ãâ²¼Ïß»ùÕ¾V1.46-4G.Bin"); // FLASH_Prepare(0x08008000 , 30); // FLASH_Write(0x08008000 ,temp_arr,temp_arr_len ); //} /** * @} */ /************************ (C) COPYRIGHT STMicroelectronics *****END OF FILE****/