/****************************************************************************** * Copyright (c) 20203, Freqchip * * All rights reserved. * * */ #include #include //#include #include "fr30xx.h" #include "co_util.h" #include "gap_api.h" #include "gatt_api.h" #include "FreeRTOS.h" #include "timers.h" #include "app_ota.h" #include "app_ota_service.h" /****************************************************************************** * MACROS (宏定义) */ /***************************************************************************** * CONSTANTS (常量定义) */ #define PMU_REG_FLASH_VDD_CTRL 0xFB #define IMAGE_INFO_OTA_MAGIC (0x51525251) /***************************************************************************** * TYPEDEFS (类型定义) */ __PACKED_STRUCT ota_ongoing_t{ uint8_t type; uint8_t start_flag; uint8_t erase_flag; uint8_t mac_addr[6]; }; __PACKED_STRUCT ota_file_version_t{ uint32_t otaboot_version; uint32_t app_version; uint32_t controller_version; uint32_t dsp_version; }; __PACKED_STRUCT file_info_t{ uint32_t file_version; uint32_t file_storage_base; uint32_t file_length; uint32_t file_crc; }; __PACKED_STRUCT ota_info_t{ uint8_t first_check_flag[4]; uint8_t file_type; //烧录文件中，所包含的文件类型 struct file_info_t boot_file_info; struct file_info_t app_file_info; struct file_info_t controller_file_info; struct file_info_t dsp_file_info; uint8_t controller_flag; struct ota_ongoing_t ota_ongoing; uint32_t rsv[10]; }; __PACKED_STRUCT firmware_version { uint32_t firmware_version; } __attribute__((packed)); __PACKED_STRUCT storage_baseaddr { uint32_t baseaddr; } __attribute__((packed)); __PACKED_STRUCT page_erase_rsp { uint32_t base_address; } __attribute__((packed)); __PACKED_STRUCT write_mem_rsp { uint32_t base_address; uint16_t length; } __attribute__((packed)); __PACKED_STRUCT read_mem_rsp { uint32_t base_address; uint16_t length; } __attribute__((packed)); __PACKED_STRUCT write_data_rsp { uint32_t base_address; uint16_t length; } __attribute__((packed)); __PACKED_STRUCT read_data_rsp { uint32_t base_address; uint16_t length; } __attribute__((packed)); __PACKED_STRUCT ota_start_rsp { uint32_t ota_start; } __attribute__((packed)); __PACKED_STRUCT ota_finish_rsp { uint32_t ota_finsih_state; } __attribute__((packed)); __PACKED_STRUCT app_ota_rsp_hdr_t { uint8_t result; uint8_t org_opcode; uint16_t length; __PACKED union { uint8_t nvds_type; struct firmware_version version; struct storage_baseaddr baseaddr; struct page_erase_rsp page_erase; struct write_mem_rsp write_mem; struct read_mem_rsp read_mem; struct write_data_rsp write_data; struct read_data_rsp read_data; struct ota_finish_rsp finsih_rsp; struct ota_start_rsp ota_start; } __attribute__((packed)) rsp; } __attribute__((packed)); __PACKED_STRUCT page_erase_cmd { uint32_t base_address; } __attribute__((packed)); __PACKED_STRUCT write_mem_cmd { uint32_t base_address; uint16_t length; } __attribute__((packed)); __PACKED_STRUCT read_mem_cmd { uint32_t base_address; uint16_t length; } __attribute__((packed)); __PACKED_STRUCT write_data_cmd { uint32_t base_address; uint16_t length; } __attribute__((packed)); __PACKED_STRUCT read_data_cmd { uint32_t base_address; uint16_t length; } __attribute__((packed)); __PACKED_STRUCT firmware_check { uint32_t firmware_length; uint32_t CRC32_data; } __attribute__((packed)); __PACKED_STRUCT app_ota_cmd_hdr_t { uint8_t opcode; uint16_t length; __PACKED union { struct page_erase_cmd page_erase; struct write_mem_cmd write_mem; struct read_mem_cmd read_mem; struct write_data_cmd write_data; struct read_data_cmd read_data; struct firmware_check fir_crc_data; } __attribute__((packed)) cmd; } __attribute__((packed)); struct image_info_t { uint32_t image_version; uint32_t image_offset; // storage offset uint32_t image_length; uint32_t execute_offset; // execute offset uint32_t copy_unit; // 4K, 8K, 16K, 32K, 64K, 128K uint32_t copy_flag_store_step; // 4, 8, 16, 32, 64 uint32_t image_crc; uint32_t image_valid; uint32_t image_tlv_length; // Hash,signa length uint32_t options; uint32_t info_crc; uint32_t ota_magic; // 需要更新标志 }; __PACKED_STRUCT otas_send_rsp { uint8_t conidx; uint16_t length; uint8_t *buffer; }; __PACKED_STRUCT source_file_info_t{ uint8_t check_buff[4]; uint32_t version; uint32_t length; uint32_t crc; }; typedef unsigned int uLong; typedef unsigned int uInt; typedef uLong uLongf; typedef unsigned char Byte; typedef Byte Bytef; #define ZEXPORT #define OF(a) a #define Z_NULL 0 #define local static #define IMAGE_INFO_CRC_ZONE_LEN ((uint32_t)(&((struct image_info_t *)0)->info_crc)) /****************************************************************************** * LOCAL VARIABLES (局部变量) */ static uint8_t first_loop; const uint8_t ota_check_data[4] = {0x43,0x75,0x28,0x19}; const uint8_t app_check_data[4] = {0x55,0xAA,0x55,0xAA}; const uint8_t controller_check_data[4] = {0x55,0xAA,0xAA,0x55}; const uint8_t dsp_check_data[4] = {0xAA,0x55,0x55,0xAA}; static void app_boot_retarget(uint32_t target); static uint32_t ota_imagesize = 0; static TimerHandle_t xTimer_OtaTimerOut = NULL; static uint16_t at_data_idx; static uint32_t firmware_vesion_new = 0; static uint32_t firmware_size_new = 0; static uint32_t ota_ongoing_base = 0; static uint32_t ota_ongoing_max_code_size = 0; static uint8_t file_type = 0; uint32_t Crc32CalByByte(int crc,uint8_t* ptr, int len); /****************************************************************************** * GLOBAL VARIABLES (全局变量) */ struct app_otas_status_t app_otas_status; struct ota_info_t * ota_info; extern adv_handle ota_adv; extern uint8_t ble_static_addr[6]; /****************************************************************************** * LOCAL FUNCTIONS (本地函数) */ __RAM_CODE static uint8_t app_otas_crc_cal(uint32_t firmware_length,uint32_t new_bin_addr,uint32_t crc_data_t); uLong ZEXPORT crc32(uLong crc, const Bytef *buf, uInt len); uint32_t get_boot_crc(uint32_t imagesize,uint32_t length); /****************************************************************************** * EXTERN FUNCTIONS (外部函数) */ extern void wdt_rst_start(void); extern void user_controller_init(void); /********************************************************************* * @fn check_file_integrity * * @brief check file intergrity when ota start, * if file not intergrity,adv always on. * else close ota */ void check_file_integrity(void) { if(ota_info->ota_ongoing.erase_flag) { adv_timeout_TimerStop(); }else{ /*ota disable*/ ota_info->ota_ongoing.start_flag = 0; flash_write(QSPI0,BOOT_B_INFO_ADDRESS,sizeof(struct ota_info_t),(uint8_t *)ota_info); wdt_rst_start(); } } void show_reg(uint8_t *buffer,uint16_t length) { for(int i = 0; i < length; i++) { printf("%02x ",buffer[i]); } printf("\r\n"); } void print_info(struct source_file_info_t * info) { printf("\ncheck:%02x,%02x,%02x,%02x",info->check_buff[0],info->check_buff[1], info->check_buff[2],info->check_buff[3]); printf("\nversion:%08x",info->version); printf("\nlength:%08x",info->length); printf("\ncrc:%08x\r\n",info->crc); } /********************************************************************* * @fn get_ota_info * * @brief 第一次上电的时候，获取文件有效信息 */ bool get_ota_info(void) { struct ota_info_t get_ota_info; flash_read(QSPI0,OTA_BOOT_INFO_ADDRESS,sizeof(struct ota_info_t),(uint8_t *)&get_ota_info); /*检查是不是第一次上电，第一次上电，从文件中读取文件信息*/ if(memcmp(get_ota_info.first_check_flag,ota_check_data,4) != 0) { struct source_file_info_t src_info; struct image_info_t image_info; /*获取boot有效信息,版本号，存储地址，程序长度，crc*/ flash_read(QSPI0,BOOT_A_INFO_ADDRESS,sizeof(struct image_info_t),(uint8_t *)&image_info); get_ota_info.boot_file_info.file_version = image_info.image_version; get_ota_info.boot_file_info.file_storage_base = OTA_B_STORAGE_ADDRESS; get_ota_info.boot_file_info.file_length = image_info.image_length; get_ota_info.boot_file_info.file_crc = image_info.image_crc; get_ota_info.file_type = 0; /*获取app有效信息,版本号，存储地址，程序长度，crc*/ flash_read(QSPI0,APP_CODE_STORAGE_ADDRESS+APP_CODE_INFO_OFFSET,sizeof(struct source_file_info_t),(uint8_t *)&src_info); print_info(&src_info); if(memcmp(src_info.check_buff,app_check_data,4) == 0) { uint32_t app_code_crc; get_ota_info.app_file_info.file_version = src_info.version; get_ota_info.app_file_info.file_storage_base = APP_CODE_STORAGE_ADDRESS; get_ota_info.app_file_info.file_length = src_info.length; flash_read(QSPI0,APP_CODE_STORAGE_ADDRESS+src_info.length,4,(uint8_t *)&app_code_crc); get_ota_info.app_file_info.file_crc = app_code_crc; get_ota_info.file_type |= FILE_TYPE_APP; printf("app crc:%x\r\n",get_ota_info.app_file_info.file_crc); }else{ return false; } /* 1、检测controller地址是否controller有效信息，有设置controller flag为1，表示会在应用层初始化controller 否则，boot里面初始化controller 2、获取controller有效信息,版本号，存储地址，程序长度，crc */ flash_read(QSPI0,CONTROLLER_STORAGE_ADDRESS,sizeof(struct source_file_info_t),(uint8_t *)&src_info); printf("controller:%x\r\n",CONTROLLER_STORAGE_ADDRESS); print_info(&src_info); // if(memcmp(src_info.check_buff,controller_check_data,4) == 0 ) { get_ota_info.controller_flag = 1; get_ota_info.controller_file_info.file_version = src_info.version; get_ota_info.controller_file_info.file_storage_base = CONTROLLER_STORAGE_ADDRESS; get_ota_info.controller_file_info.file_crc = src_info.crc; get_ota_info.controller_file_info.file_length = src_info.length; get_ota_info.file_type |= FILE_CONTROLLER; } // else{ // get_ota_info.controller_flag = 0; // } /*获取DSP有效信息,版本号，存储地址，程序长度，crc*/ flash_read(QSPI0,DSP_STORAGE_ADDRESS,sizeof(struct source_file_info_t),(uint8_t *)&src_info); printf("dsp:%x\r\n",DSP_STORAGE_ADDRESS); print_info(&src_info); // if(memcmp(src_info.check_buff,dsp_check_data,4) == 0) { get_ota_info.dsp_file_info.file_version = src_info.version; get_ota_info.dsp_file_info.file_storage_base = DSP_STORAGE_ADDRESS; get_ota_info.dsp_file_info.file_crc = src_info.crc; get_ota_info.dsp_file_info.file_length = src_info.length; get_ota_info.file_type |= FILE_TYPE_DSP; } /*初始化ota 升级时的状态信息*/ get_ota_info.ota_ongoing.start_flag = 0; get_ota_info.ota_ongoing.erase_flag = 0; memcpy(get_ota_info.first_check_flag,ota_check_data,4); flash_erase(QSPI0,OTA_BOOT_INFO_ADDRESS,0x1000); flash_write(QSPI0,OTA_BOOT_INFO_ADDRESS,sizeof(struct ota_info_t),(uint8_t *)&get_ota_info); } return true; } /********************************************************************* * @fn Document_validity_check * * @brief 校验APP，DSP，CONTROLLER程序 */ bool Document_validity_check(void) { #if DOCUMENT_CHECK struct ota_info_t get_ota_info; bool status = true; flash_read(QSPI0,OTA_BOOT_INFO_ADDRESS,sizeof(struct ota_info_t),(uint8_t *)&get_ota_info); printf("validity type:%02x\r\n",get_ota_info.file_type); do { /*对app文件进行校验*/ if(get_ota_info.file_type & FILE_TYPE_APP) { printf("address:%x,length:%x\r\n",get_ota_info.app_file_info.file_storage_base,get_ota_info.app_file_info.file_length); if(get_boot_crc(get_ota_info.app_file_info.file_storage_base,get_ota_info.app_file_info.file_length) == get_ota_info.app_file_info.file_crc) { status = true; }else{ status = false; break; } }else{ status = false; break; } #if 0 /*对control文件进行校验*/ if(get_ota_info.file_type & FILE_TYPE_CONTROLLER) { printf("address:%x,length:%x\r\n",get_ota_info.controller_file_info.file_storage_base,get_ota_info.controller_file_info.file_length); if(get_boot_crc(get_ota_info.controller_file_info.file_storage_base+FILE_CODE_ADDRESS_OFFSET,get_ota_info.controller_file_info.file_length) == get_ota_info.controller_file_info.file_crc) { status = true; }else{ status = false; break; } } /*对dsp文件进行校验*/ if(get_ota_info.file_type & FILE_TYPE_DSP) { printf("address:%x,length:%x\r\n",get_ota_info.dsp_file_info.file_storage_base,get_ota_info.dsp_file_info.file_length); if(get_boot_crc(get_ota_info.dsp_file_info.file_storage_base+FILE_CODE_ADDRESS_OFFSET,get_ota_info.dsp_file_info.file_length) == get_ota_info.dsp_file_info.file_crc) { status = true; }else{ status = false; break; } } #endif }while(0); #else bool status = true; #endif return status; } /********************************************************************* * @fn ota_boot_start * */ void ota_boot_start(void) { if(get_ota_info() == true) { struct ota_info_t get_ota_info; flash_read(QSPI0,OTA_BOOT_INFO_ADDRESS,sizeof(struct ota_info_t),(uint8_t *)&get_ota_info); /*判断需不需要ota 升级*/ if(get_ota_info.ota_ongoing.start_flag != 0x01) { /*对文件有效性进行检查，如果没有文件则进入默认boot程序*/ if((Document_validity_check() == true)) { /*判断应用层初始化controller还是boot初始化controller*/ if(get_ota_info.controller_flag == 0x01 ) { printf("controller code\r\n"); co_delay_100us(100); /*jump new address*/ app_boot_retarget(RETARGET_APP_CODE_ADDRESS); while(1); }else{ printf("no controller code\r\n"); /*control init*/ user_controller_init(); /*jump new address*/ app_boot_retarget(RETARGET_APP_CODE_ADDRESS); while(1); } }else{ ota_info = pvPortMalloc(sizeof(struct ota_info_t)); flash_read(QSPI0,OTA_BOOT_INFO_ADDRESS,sizeof(struct ota_info_t),(uint8_t *)ota_info); } }else{ /*进入ota程序，获取ota 信息，并且设置ota升级地址*/ ota_info = pvPortMalloc(sizeof(struct ota_info_t)); flash_read(QSPI0,OTA_BOOT_INFO_ADDRESS,sizeof(struct ota_info_t),(uint8_t *)ota_info); memcpy(ble_static_addr,ota_info->ota_ongoing.mac_addr,6); } }else{ ota_info = pvPortMalloc(sizeof(struct ota_info_t)); flash_read(QSPI0,OTA_BOOT_INFO_ADDRESS,sizeof(struct ota_info_t),(uint8_t *)ota_info); memset(ota_info->first_check_flag,0,4); ota_info->app_file_info.file_version = 0; ota_info->boot_file_info.file_version = 0; ota_info->controller_file_info.file_version = 0; ota_info->dsp_file_info.file_version = 0; ota_info->app_file_info.file_storage_base = APP_CODE_STORAGE_ADDRESS; ota_info->boot_file_info.file_storage_base = OTA_B_STORAGE_ADDRESS; ota_info->controller_file_info.file_storage_base = CONTROLLER_STORAGE_ADDRESS; ota_info->dsp_file_info.file_storage_base = DSP_STORAGE_ADDRESS; ota_info->ota_ongoing.start_flag = 1; ota_info->ota_ongoing.erase_flag = 1; ota_info->file_type = 0; } } /********************************************************************* * @fn ota_init * * @brief Initialization ota */ void ota_init(void) { app_otas_status.read_opcode = OTA_CMD_NULL; first_loop = true; at_data_idx = 0; } /********************************************************************* * @fn ota_deinit * * @brief reset chip,when ota abnormal disconnection */ void ota_deinit(void) { wdt_rst_start(); } /********************************************************************* * @fn platform_reset * * @brief reset chip */ void platform_reset(void) { // Disable interrupts __disable_irq(); ool_write(PMU_REG_FLASH_VDD_CTRL, ool_read(PMU_REG_FLASH_VDD_CTRL) & 0xFE); co_delay_100us(300); NVIC_SystemReset(); } /********************************************************************* * @fn ota_set_imagesize * * @brief set ota file size */ void ota_set_imagesize(uint32_t imagesize) { ota_imagesize = imagesize; } /********************************************************************* * @fn ota_set_imagesize * * @brief get ota file size */ uint32_t ota_get_imagesize(void) { return ota_imagesize; } /********************************************************************* * @fn app_boot_retarget * * @brief 重映射中断向量表，MSP指针，代码跳转RAM执行 */ __RAM_CODE static void app_boot_retarget(uint32_t target) { static str_CoreRemapStart_t *CoreRemapStart; CoreRemapStart = (str_CoreRemapStart_t *)target; /* Disable SysTick */ SysTick->CTRL = 0; /* Modify intrerrupt vector table */ SCB->VTOR = target; __set_MSP((volatile uint32_t)CoreRemapStart->MSP); ((void (*)(void))(CoreRemapStart->Reset_Handler | 0x01))(); } /********************************************************************* * @fn app_otas_read_data * * @brief Read Data * * @param Read Data Buffer. * * * @return Read Data Length. */ uint16_t app_otas_read_data(uint8_t *p_data) { uint16_t length; switch(app_otas_status.read_opcode) { case OTA_CMD_READ_DATA: length = app_otas_status.length; break; case OTA_CMD_READ_MEM: length = app_otas_status.length; break; default: length = 0; break; } app_otas_status.read_opcode = OTA_CMD_NULL; return length; } /********************************************************************* * @fn ota_start_cb * * @brief stop start,reset chip * */ void ota_start_callback(TimerHandle_t pxTimer) { xTimerStop(xTimer_OtaTimerOut,0); ota_deinit(); } /********************************************************************* * @fn ota_start * * @brief ota timeout enable * */ void ota_start(void) { if(xTimer_OtaTimerOut == NULL) { xTimer_OtaTimerOut = xTimerCreate("ota",OTA_START_TIMOUT/portTICK_PERIOD_MS,pdFALSE,NULL,ota_start_callback); xTimerStart(xTimer_OtaTimerOut,0); }else{ xTimerStop(xTimer_OtaTimerOut,0); xTimerStart(xTimer_OtaTimerOut,0); } } /********************************************************************* * @fn ota_stop * * @brief close ota stop * */ void ota_stop(void) { xTimerStop(xTimer_OtaTimerOut,0); } /********************************************************************* * @fn app_otas_recv_data * * @brief Otas Data handler * */ void app_otas_recv_data(uint8_t conidx,uint8_t *p_data,uint16_t len) { struct app_ota_cmd_hdr_t *cmd_hdr = (struct app_ota_cmd_hdr_t *)p_data; struct app_ota_rsp_hdr_t *rsp_hdr; uint16_t rsp_data_len = (OTA_HDR_OPCODE_LEN+OTA_HDR_LENGTH_LEN+OTA_HDR_RESULT_LEN); if(first_loop) { /*close adv time out*/ adv_timeout_TimerStop(); first_loop = false; } ota_start(); at_data_idx++; switch(cmd_hdr->opcode) { case OTA_CMD_NVDS_TYPE: rsp_data_len += 1; break; case OTA_CMD_GET_STR_BASE: at_data_idx = 0; rsp_data_len += sizeof(struct storage_baseaddr); break; case OTA_CMD_READ_FW_VER: rsp_data_len += sizeof(struct firmware_version); break; case OTA_CMD_PAGE_ERASE: rsp_data_len += sizeof(struct page_erase_rsp); break; case OTA_CMD_WRITE_DATA: rsp_data_len += sizeof(struct write_data_rsp); break; case OTA_CMD_READ_DATA: rsp_data_len += sizeof(struct read_data_rsp) + cmd_hdr->cmd.read_data.length; if(rsp_data_len > OTAS_NOTIFY_DATA_SIZE) { rsp_data_len = sizeof(struct read_data_rsp) + (OTA_HDR_OPCODE_LEN+OTA_HDR_LENGTH_LEN+OTA_HDR_RESULT_LEN); app_otas_status.read_opcode = OTA_CMD_READ_DATA; app_otas_status.length = cmd_hdr->cmd.read_data.length; app_otas_status.base_addr = cmd_hdr->cmd.read_data.base_address; } break; case OTA_CMD_WRITE_MEM: rsp_data_len += sizeof(struct write_mem_rsp); break; case OTA_CMD_READ_MEM: rsp_data_len += sizeof(struct read_mem_rsp) + cmd_hdr->cmd.read_mem.length; if(rsp_data_len > OTAS_NOTIFY_DATA_SIZE) { rsp_data_len = sizeof(struct read_data_rsp) + (OTA_HDR_OPCODE_LEN+OTA_HDR_LENGTH_LEN+OTA_HDR_RESULT_LEN); app_otas_status.read_opcode = OTA_CMD_READ_MEM; app_otas_status.length = cmd_hdr->cmd.read_data.length; app_otas_status.base_addr = cmd_hdr->cmd.read_data.base_address; } else { app_otas_status.read_opcode = OTA_CMD_NULL; } break; case OTA_CMD_START: rsp_data_len += sizeof(struct ota_start_rsp); break; case OTA_CMD_NULL: return; } struct otas_send_rsp *req = pvPortMalloc(sizeof(struct otas_send_rsp)); uint16_t base_length; req->conidx = conidx; req->length = rsp_data_len; req->buffer = pvPortMalloc(rsp_data_len); rsp_hdr = (struct app_ota_rsp_hdr_t *)&req->buffer[0]; rsp_hdr->result = OTA_RSP_SUCCESS; rsp_hdr->org_opcode = cmd_hdr->opcode; rsp_hdr->length = rsp_data_len - (OTA_HDR_OPCODE_LEN+OTA_HDR_LENGTH_LEN+OTA_HDR_RESULT_LEN); switch(cmd_hdr->opcode) { case OTA_CMD_NVDS_TYPE: rsp_hdr->rsp.nvds_type = 0x01; break; case OTA_CMD_GET_STR_BASE: //获取存储地址 switch(ota_info->ota_ongoing.type) { case FILE_BOOT_LOADER: rsp_hdr->rsp.baseaddr.baseaddr = ota_info->boot_file_info.file_storage_base; ota_ongoing_base = ota_info->boot_file_info.file_storage_base; ota_ongoing_max_code_size = BOOT_CODE_MAX_SIZE; break; case FILE_APP: rsp_hdr->rsp.baseaddr.baseaddr = ota_info->app_file_info.file_storage_base; ota_ongoing_base = ota_info->app_file_info.file_storage_base; ota_ongoing_max_code_size = APP_CODE_MAX_SIZE; break; case FILE_CONTROLLER: rsp_hdr->rsp.baseaddr.baseaddr = ota_info->controller_file_info.file_storage_base; ota_ongoing_base = ota_info->controller_file_info.file_storage_base; ota_ongoing_max_code_size = CONTROLLER_CODE_MAX_SIZE; break; case FILE_DSP: rsp_hdr->rsp.baseaddr.baseaddr = ota_info->dsp_file_info.file_storage_base; ota_ongoing_base = ota_info->dsp_file_info.file_storage_base; ota_ongoing_max_code_size = DSP_CODE_MAX_SIZE; break; } break; case OTA_CMD_READ_FW_VER: //获取版本号 { uint8_t type; type = *(p_data + (OTA_HDR_OPCODE_LEN+OTA_HDR_LENGTH_LEN)); switch(type) { case FILE_BOOT_LOADER: rsp_hdr->rsp.version.firmware_version = ota_info->boot_file_info.file_version; break; case FILE_APP: rsp_hdr->rsp.version.firmware_version = ota_info->app_file_info.file_version; break; case FILE_CONTROLLER: rsp_hdr->rsp.version.firmware_version = ota_info->controller_file_info.file_version; break; case FILE_DSP: rsp_hdr->rsp.version.firmware_version = ota_info->dsp_file_info.file_version; break; } } break; case OTA_CMD_PAGE_ERASE: //擦除 { rsp_hdr->rsp.page_erase.base_address = cmd_hdr->cmd.page_erase.base_address; printf("erase:%x\r\n",cmd_hdr->cmd.page_erase.base_address); /*设置擦除状态*/ if(ota_info->ota_ongoing.erase_flag == 0) { ota_info->ota_ongoing.erase_flag = 1; GLOBAL_INT_DISABLE(); flash_erase(QSPI0,OTA_BOOT_INFO_ADDRESS,0x1000); flash_write(QSPI0,OTA_BOOT_INFO_ADDRESS,sizeof(struct ota_info_t),(uint8_t *)ota_info); GLOBAL_INT_RESTORE(); } /*判断下发的擦除地址是否小于存储地址*/ if(rsp_hdr->rsp.page_erase.base_address < ota_ongoing_base) { /*disconnect link*/ gap_disconnect(conidx); } else if(rsp_hdr->rsp.page_erase.base_address >= (ota_ongoing_base+ota_ongoing_max_code_size)) { /*disconnect link*/ printf("erase over size\r\n"); gap_disconnect(conidx); } else { GLOBAL_INT_DISABLE(); flash_erase(QSPI0,rsp_hdr->rsp.page_erase.base_address, 0x1000); GLOBAL_INT_RESTORE(); } } break; case OTA_CMD_CHIP_ERASE: break; case OTA_CMD_WRITE_DATA: //导入数据 { printf("program:%x,length:%d\r\n",rsp_hdr->rsp.write_data.base_address,rsp_hdr->rsp.write_data.length); rsp_hdr->rsp.write_data.base_address = cmd_hdr->cmd.write_data.base_address; rsp_hdr->rsp.write_data.length = cmd_hdr->cmd.write_data.length; /*判断下发的烧录地址是否小于存储地址*/ if(rsp_hdr->rsp.write_data.base_address < ota_ongoing_base) { /*disconnect link*/ gap_disconnect(conidx); } else if(rsp_hdr->rsp.write_data.base_address+rsp_hdr->rsp.write_data.length > (ota_ongoing_base+ota_ongoing_max_code_size)) { /*disconnect link*/ printf("program over size\r\n"); gap_disconnect(conidx); } else { GLOBAL_INT_DISABLE(); /*flash write*/ flash_write(QSPI0,rsp_hdr->rsp.write_data.base_address, rsp_hdr->rsp.write_data.length, p_data + (OTA_HDR_OPCODE_LEN+OTA_HDR_LENGTH_LEN)+sizeof(struct write_data_cmd)); GLOBAL_INT_RESTORE(); } } break; case OTA_CMD_READ_DATA: rsp_hdr->rsp.read_data.base_address = cmd_hdr->cmd.read_data.base_address; rsp_hdr->rsp.read_data.length = cmd_hdr->cmd.read_data.length; base_length = sizeof(struct read_data_rsp) + (OTA_HDR_OPCODE_LEN+OTA_HDR_LENGTH_LEN+OTA_HDR_RESULT_LEN); if(rsp_data_len != base_length) { flash_read(QSPI0,rsp_hdr->rsp.read_data.base_address, rsp_hdr->rsp.read_data.length, (uint8_t*)rsp_hdr+base_length); } break; case OTA_CMD_WRITE_MEM: rsp_hdr->rsp.write_mem.base_address = cmd_hdr->cmd.write_mem.base_address; rsp_hdr->rsp.write_mem.length = cmd_hdr->cmd.write_mem.length; memcpy((void *)rsp_hdr->rsp.write_mem.base_address, p_data + (OTA_HDR_OPCODE_LEN+OTA_HDR_LENGTH_LEN)+sizeof(struct write_data_cmd), rsp_hdr->rsp.write_mem.length); break; case OTA_CMD_READ_MEM: rsp_hdr->rsp.read_mem.base_address = cmd_hdr->cmd.read_mem.base_address; rsp_hdr->rsp.read_mem.length = cmd_hdr->cmd.read_mem.length; base_length = sizeof(struct read_mem_rsp) + (OTA_HDR_OPCODE_LEN+OTA_HDR_LENGTH_LEN+OTA_HDR_RESULT_LEN); if(rsp_data_len != base_length) { memcpy((uint8_t*)rsp_hdr+base_length, (void *)rsp_hdr->rsp.read_mem.base_address, rsp_hdr->rsp.read_data.length); } break; case OTA_CMD_REBOOT: //复位重启 { printf("crc base:%x,length:%x\r\n",ota_ongoing_base,cmd_hdr->cmd.fir_crc_data.firmware_length); if(app_otas_crc_cal(cmd_hdr->cmd.fir_crc_data.firmware_length,ota_ongoing_base,cmd_hdr->cmd.fir_crc_data.CRC32_data)) { switch(ota_info->ota_ongoing.type) { case FILE_BOOT_LOADER: { volatile struct image_info_t image_info; flash_read(QSPI0,BOOT_A_INFO_ADDRESS,sizeof(struct image_info_t),(uint8_t *)&image_info); image_info.image_version += 1; image_info.image_offset = OTA_B_STORAGE_ADDRESS; image_info.image_length = cmd_hdr->cmd.fir_crc_data.firmware_length; image_info.ota_magic = IMAGE_INFO_OTA_MAGIC; image_info.image_crc = get_boot_crc(ota_ongoing_base,cmd_hdr->cmd.fir_crc_data.firmware_length); image_info.info_crc = crc32(0x00000000,(uint8_t *)&image_info,IMAGE_INFO_CRC_ZONE_LEN); printf("image_info_crc:%x\r\n",image_info.info_crc); GLOBAL_INT_DISABLE(); flash_erase(QSPI0,BOOT_B_INFO_ADDRESS,0x1000); flash_write(QSPI0,BOOT_B_INFO_ADDRESS,sizeof(struct image_info_t),(uint8_t *)&image_info); GLOBAL_INT_RESTORE(); ota_info->boot_file_info.file_version = image_info.image_version; ota_info->boot_file_info.file_length = image_info.image_length; ota_info->boot_file_info.file_crc = image_info.image_crc; rsp_hdr->rsp.finsih_rsp.ota_finsih_state = 1; ota_info->ota_ongoing.start_flag = 0; ota_info->ota_ongoing.erase_flag = 0; } break; case FILE_APP: { struct source_file_info_t src_info; uint32_t app_code_crc; flash_read(QSPI0,APP_CODE_STORAGE_ADDRESS+APP_CODE_INFO_OFFSET,sizeof(struct source_file_info_t),(uint8_t *)&src_info); if(memcmp(src_info.check_buff,app_check_data,4) == 0) { ota_info->app_file_info.file_version = src_info.version; ota_info->app_file_info.file_length = src_info.length; flash_read(QSPI0,APP_CODE_STORAGE_ADDRESS+src_info.length,4,(uint8_t *)&app_code_crc); ota_info->app_file_info.file_crc = app_code_crc; rsp_hdr->rsp.finsih_rsp.ota_finsih_state = 1; ota_info->ota_ongoing.start_flag = 0; ota_info->ota_ongoing.erase_flag = 0; }else{ rsp_hdr->rsp.finsih_rsp.ota_finsih_state = 0; printf("app ota fail\r\n"); } } break; case FILE_CONTROLLER: { struct source_file_info_t src_info; flash_read(QSPI0,CONTROLLER_STORAGE_ADDRESS,sizeof(struct source_file_info_t),(uint8_t *)&src_info); if(memcmp(src_info.check_buff,controller_check_data,4) == 0 ) { ota_info->controller_file_info.file_length = src_info.length; ota_info->controller_file_info.file_version = src_info.version; ota_info->controller_file_info.file_crc = src_info.crc; rsp_hdr->rsp.finsih_rsp.ota_finsih_state = 1; ota_info->ota_ongoing.start_flag = 0; ota_info->ota_ongoing.erase_flag = 0; }else{ rsp_hdr->rsp.finsih_rsp.ota_finsih_state = 0; printf("controller ota fail\r\n"); } } break; case FILE_DSP: { struct source_file_info_t src_info; flash_read(QSPI0,DSP_STORAGE_ADDRESS,sizeof(struct source_file_info_t),(uint8_t *)&src_info); if(memcmp(src_info.check_buff,dsp_check_data,4) == 0) { ota_info->dsp_file_info.file_length = src_info.length; ota_info->dsp_file_info.file_version = src_info.version; ota_info->dsp_file_info.file_crc = src_info.crc; rsp_hdr->rsp.finsih_rsp.ota_finsih_state = 1; ota_info->ota_ongoing.start_flag = 0; ota_info->ota_ongoing.erase_flag = 0; }else{ rsp_hdr->rsp.finsih_rsp.ota_finsih_state = 0; printf("dsp ota fail\r\n"); } } break; } GLOBAL_INT_DISABLE(); flash_erase(QSPI0,OTA_BOOT_INFO_ADDRESS,0x1000); flash_write(QSPI0,OTA_BOOT_INFO_ADDRESS,sizeof(struct ota_info_t),(uint8_t *)ota_info); GLOBAL_INT_RESTORE(); printf("crc finish\r\n"); wdt_rst_start(); }else{ printf("crc error\r\n"); rsp_hdr->rsp.finsih_rsp.ota_finsih_state = 0; wdt_rst_start(); } } break; case OTA_CMD_START: { rsp_hdr->rsp.ota_start.ota_start = 1; } break; default: rsp_hdr->result = OTA_RSP_UNKNOWN_CMD; break; } ota_gatt_report_notify(conidx,req->buffer,req->length); vPortFree(req->buffer); vPortFree(req); } /********************************************************************* * * @brief Check ota file * */ local const uLongf crc_table[256] = { 0x00000000L, 0x77073096L, 0xee0e612cL, 0x990951baL, 0x076dc419L, 0x706af48fL, 0xe963a535L, 0x9e6495a3L, 0x0edb8832L, 0x79dcb8a4L, 0xe0d5e91eL, 0x97d2d988L, 0x09b64c2bL, 0x7eb17cbdL, 0xe7b82d07L, 0x90bf1d91L, 0x1db71064L, 0x6ab020f2L, 0xf3b97148L, 0x84be41deL, 0x1adad47dL, 0x6ddde4ebL, 0xf4d4b551L, 0x83d385c7L, 0x136c9856L, 0x646ba8c0L, 0xfd62f97aL, 0x8a65c9ecL, 0x14015c4fL, 0x63066cd9L, 0xfa0f3d63L, 0x8d080df5L, 0x3b6e20c8L, 0x4c69105eL, 0xd56041e4L, 0xa2677172L, 0x3c03e4d1L, 0x4b04d447L, 0xd20d85fdL, 0xa50ab56bL, 0x35b5a8faL, 0x42b2986cL, 0xdbbbc9d6L, 0xacbcf940L, 0x32d86ce3L, 0x45df5c75L, 0xdcd60dcfL, 0xabd13d59L, 0x26d930acL, 0x51de003aL, 0xc8d75180L, 0xbfd06116L, 0x21b4f4b5L, 0x56b3c423L, 0xcfba9599L, 0xb8bda50fL, 0x2802b89eL, 0x5f058808L, 0xc60cd9b2L, 0xb10be924L, 0x2f6f7c87L, 0x58684c11L, 0xc1611dabL, 0xb6662d3dL, 0x76dc4190L, 0x01db7106L, 0x98d220bcL, 0xefd5102aL, 0x71b18589L, 0x06b6b51fL, 0x9fbfe4a5L, 0xe8b8d433L, 0x7807c9a2L, 0x0f00f934L, 0x9609a88eL, 0xe10e9818L, 0x7f6a0dbbL, 0x086d3d2dL, 0x91646c97L, 0xe6635c01L, 0x6b6b51f4L, 0x1c6c6162L, 0x856530d8L, 0xf262004eL, 0x6c0695edL, 0x1b01a57bL, 0x8208f4c1L, 0xf50fc457L, 0x65b0d9c6L, 0x12b7e950L, 0x8bbeb8eaL, 0xfcb9887cL, 0x62dd1ddfL, 0x15da2d49L, 0x8cd37cf3L, 0xfbd44c65L, 0x4db26158L, 0x3ab551ceL, 0xa3bc0074L, 0xd4bb30e2L, 0x4adfa541L, 0x3dd895d7L, 0xa4d1c46dL, 0xd3d6f4fbL, 0x4369e96aL, 0x346ed9fcL, 0xad678846L, 0xda60b8d0L, 0x44042d73L, 0x33031de5L, 0xaa0a4c5fL, 0xdd0d7cc9L, 0x5005713cL, 0x270241aaL, 0xbe0b1010L, 0xc90c2086L, 0x5768b525L, 0x206f85b3L, 0xb966d409L, 0xce61e49fL, 0x5edef90eL, 0x29d9c998L, 0xb0d09822L, 0xc7d7a8b4L, 0x59b33d17L, 0x2eb40d81L, 0xb7bd5c3bL, 0xc0ba6cadL, 0xedb88320L, 0x9abfb3b6L, 0x03b6e20cL, 0x74b1d29aL, 0xead54739L, 0x9dd277afL, 0x04db2615L, 0x73dc1683L, 0xe3630b12L, 0x94643b84L, 0x0d6d6a3eL, 0x7a6a5aa8L, 0xe40ecf0bL, 0x9309ff9dL, 0x0a00ae27L, 0x7d079eb1L, 0xf00f9344L, 0x8708a3d2L, 0x1e01f268L, 0x6906c2feL, 0xf762575dL, 0x806567cbL, 0x196c3671L, 0x6e6b06e7L, 0xfed41b76L, 0x89d32be0L, 0x10da7a5aL, 0x67dd4accL, 0xf9b9df6fL, 0x8ebeeff9L, 0x17b7be43L, 0x60b08ed5L, 0xd6d6a3e8L, 0xa1d1937eL, 0x38d8c2c4L, 0x4fdff252L, 0xd1bb67f1L, 0xa6bc5767L, 0x3fb506ddL, 0x48b2364bL, 0xd80d2bdaL, 0xaf0a1b4cL, 0x36034af6L, 0x41047a60L, 0xdf60efc3L, 0xa867df55L, 0x316e8eefL, 0x4669be79L, 0xcb61b38cL, 0xbc66831aL, 0x256fd2a0L, 0x5268e236L, 0xcc0c7795L, 0xbb0b4703L, 0x220216b9L, 0x5505262fL, 0xc5ba3bbeL, 0xb2bd0b28L, 0x2bb45a92L, 0x5cb36a04L, 0xc2d7ffa7L, 0xb5d0cf31L, 0x2cd99e8bL, 0x5bdeae1dL, 0x9b64c2b0L, 0xec63f226L, 0x756aa39cL, 0x026d930aL, 0x9c0906a9L, 0xeb0e363fL, 0x72076785L, 0x05005713L, 0x95bf4a82L, 0xe2b87a14L, 0x7bb12baeL, 0x0cb61b38L, 0x92d28e9bL, 0xe5d5be0dL, 0x7cdcefb7L, 0x0bdbdf21L, 0x86d3d2d4L, 0xf1d4e242L, 0x68ddb3f8L, 0x1fda836eL, 0x81be16cdL, 0xf6b9265bL, 0x6fb077e1L, 0x18b74777L, 0x88085ae6L, 0xff0f6a70L, 0x66063bcaL, 0x11010b5cL, 0x8f659effL, 0xf862ae69L, 0x616bffd3L, 0x166ccf45L, 0xa00ae278L, 0xd70dd2eeL, 0x4e048354L, 0x3903b3c2L, 0xa7672661L, 0xd06016f7L, 0x4969474dL, 0x3e6e77dbL, 0xaed16a4aL, 0xd9d65adcL, 0x40df0b66L, 0x37d83bf0L, 0xa9bcae53L, 0xdebb9ec5L, 0x47b2cf7fL, 0x30b5ffe9L, 0xbdbdf21cL, 0xcabac28aL, 0x53b39330L, 0x24b4a3a6L, 0xbad03605L, 0xcdd70693L, 0x54de5729L, 0x23d967bfL, 0xb3667a2eL, 0xc4614ab8L, 0x5d681b02L, 0x2a6f2b94L, 0xb40bbe37L, 0xc30c8ea1L, 0x5a05df1bL, 0x2d02ef8dL }; /* ========================================================================= * This function can be used by asm versions of crc32() */ const uLongf * ZEXPORT get_crc_table(void) { #ifdef DYNAMIC_CRC_TABLE if (crc_table_empty) make_crc_table(); #endif return (const uLongf *)crc_table; } /* ========================================================================= */ #define DO1(buf) crc = crc_table[((int)crc ^ (*buf++)) & 0xff] ^ (crc >> 8); #define DO2(buf) DO1(buf); DO1(buf); #define DO4(buf) DO2(buf); DO2(buf); #define DO8(buf) DO4(buf); DO4(buf); /* ========================================================================= */ uLong ZEXPORT crc32(uLong crc, const Bytef *buf, uInt len) { // if (buf == Z_NULL) return 0L; #ifdef DYNAMIC_CRC_TABLE if (crc_table_empty) make_crc_table(); #endif crc = crc ^ 0xffffffffL; while (len >= 8) { DO8(buf); len -= 8; } if (len) do { DO1(buf); } while (--len); return crc ^ 0xffffffffL; } __RAM_CODE uint32_t Crc32CalByByte(int crc,uint8_t* ptr, int len) { int i = 0; while(len-- != 0) { int high = crc/256; crc <<= 8; crc ^= crc_table[(high^ptr[i])&0xff]; crc &= 0xFFFFFFFF; i++; } return crc&0xFFFFFFFF; } __RAM_CODE static uint8_t app_otas_crc_cal(uint32_t firmware_length,uint32_t new_bin_addr,uint32_t crc_data_t) { uint32_t crc_data = 0,i = 0; uint8_t * crc_check_data = pvPortMalloc(0x1000); uint8_t ret = 0; uint32_t data_size = firmware_length; uint32_t read_address = new_bin_addr; while(data_size > 0x1000) { flash_read(QSPI0,read_address, 0x1000,crc_check_data); crc_data = Crc32CalByByte(crc_data, crc_check_data,0x1000); data_size -= 0x1000; read_address += 0x1000; } flash_read(QSPI0,read_address, data_size,crc_check_data); crc_data = Crc32CalByByte(crc_data, crc_check_data,data_size); printf("crc:%x,%x",crc_data,crc_data_t); vPortFree(crc_check_data); if(crc_data_t == crc_data) ret = 1; return ret; } uint32_t get_boot_crc(uint32_t imagesize,uint32_t length) { uint32_t crc_data = 0,i = 0; uint8_t * crc_check_data = pvPortMalloc(0x1000); uint8_t ret = 0; uint32_t data_size = length; uint32_t read_address = imagesize; while(data_size > 0x1000) { flash_read(QSPI0,read_address, 0x1000,crc_check_data); crc_data = crc32(crc_data, crc_check_data,0x1000); data_size -= 0x1000; read_address += 0x1000; } flash_read(QSPI0,read_address, data_size,crc_check_data); crc_data = crc32(crc_data, crc_check_data,data_size); printf("file crc:%x\r\n",crc_data); vPortFree(crc_check_data); return crc_data; }