303 lines
6.7 KiB
C
303 lines
6.7 KiB
C
#include "main.h"
|
|
#include "cmsis_os.h"
|
|
|
|
|
|
/* Private includes ----------------------------------------------------------*/
|
|
/* USER CODE BEGIN Includes */
|
|
#include "string.h"
|
|
#include "stm32h7xx_hal.h"
|
|
#include "stm32h7xx_it.h"
|
|
|
|
|
|
#include "W25QXX/w25qxx.h"
|
|
#include "Param/param.h"
|
|
|
|
#include "IAP/iap.h"
|
|
#include "CPY_PROT/cpy_prot.h"
|
|
|
|
typedef enum {
|
|
IAP_CMD_ERASE = 0x01,
|
|
IAP_CMD_WRITE,
|
|
IAP_CMD_CHECK,
|
|
} IAP_CMD_DEF;
|
|
|
|
#define MAX_PACKET_PARAM_NUM 4
|
|
|
|
#pragma pack(1)
|
|
|
|
typedef struct __iapPacketDef {
|
|
uint8_t ucCmd;
|
|
uint32_t aulParams[MAX_PACKET_PARAM_NUM];
|
|
uint8_t data[];
|
|
} iapPacketDef;
|
|
|
|
#pragma pack()
|
|
|
|
|
|
uint16_t getBoardTemp(void);
|
|
|
|
void systemReboot(void)
|
|
{
|
|
__disable_irq();
|
|
HAL_NVIC_SystemReset();
|
|
while (1) {
|
|
__asm("nop");
|
|
}
|
|
}
|
|
|
|
#define APPLICATION_ADDRESS 0x30000000
|
|
|
|
void copyFirmware(void)
|
|
{
|
|
uint32_t ulDstAddr = APPLICATION_ADDRESS;
|
|
uint32_t ulSrcAddr = IAP_START_SECTOR * 4096;
|
|
uint32_t ullen = 128 * 1024;
|
|
|
|
while (ullen >= 1024) {
|
|
W25QXX_Read((uint8_t *)ulDstAddr, ulSrcAddr, 1024);
|
|
ulDstAddr += 1024;
|
|
ulSrcAddr += 1024;
|
|
ullen -= 1024;
|
|
}
|
|
|
|
if (ullen > 0) {
|
|
W25QXX_Read((uint8_t *)ulDstAddr, ulSrcAddr, ullen);
|
|
}
|
|
ulDstAddr = APPLICATION_ADDRESS;
|
|
printf("0x%08X \n", ((uint32_t *)ulDstAddr)[0]);
|
|
}
|
|
|
|
void bootJump(void)
|
|
{
|
|
static uint32_t JumpAddress;
|
|
typedef void (*pFunction)(void);
|
|
static pFunction JumpToApplication;
|
|
printf("disable irq\n");
|
|
__disable_irq();
|
|
SysTick->CTRL = 0x00;
|
|
|
|
/* execute the new program */
|
|
JumpAddress = *(__IO uint32_t*) (0x08000000 + 4);
|
|
/* Jump to user application */
|
|
JumpToApplication = (pFunction) JumpAddress;
|
|
/* Initialize user application's Stack Pointer */
|
|
printf("set msp\n");
|
|
__set_MSP(*(__IO uint32_t*) 0x08000000);
|
|
__set_PSP(*(__IO uint32_t*) 0x08000000);
|
|
printf("jump\n");
|
|
JumpToApplication();
|
|
}
|
|
|
|
void appJump(void)
|
|
{
|
|
|
|
printf("jumpto addr : %0X \r\n",*(__IO uint32_t*) (APPLICATION_ADDRESS + 4));
|
|
|
|
__disable_irq();
|
|
|
|
HAL_DeInit();
|
|
|
|
SysTick->CTRL = 0x00;
|
|
|
|
/* execute the new program */
|
|
static uint32_t JumpAddress = 0;
|
|
JumpAddress = *(__IO uint32_t*) (APPLICATION_ADDRESS + 4);
|
|
/* Jump to user application */
|
|
typedef void (*pFunction)(void);
|
|
static pFunction JumpToApplication;
|
|
JumpToApplication = (pFunction) JumpAddress;
|
|
/* Initialize user application's Stack Pointer */
|
|
__set_PSP(*(volatile unsigned int*) APPLICATION_ADDRESS);
|
|
__set_CONTROL(0);
|
|
__set_MSP(*(__IO uint32_t*) APPLICATION_ADDRESS);
|
|
JumpToApplication();
|
|
}
|
|
|
|
int checkApp(void)
|
|
{
|
|
uint32_t addr;
|
|
|
|
copyFirmware();
|
|
|
|
addr = *(__IO uint32_t*) (APPLICATION_ADDRESS);
|
|
if ((addr > 0x24000000) && (addr < (0x24000000 + 0x80000))) {
|
|
printf("MSP addr : %0X \r\n",addr);
|
|
|
|
} else {
|
|
printf("MSP addr : %0X \r\n",addr);
|
|
return 0;
|
|
}
|
|
|
|
addr = *(__IO uint32_t*) (APPLICATION_ADDRESS + 4);
|
|
if ((addr > 0x30000000) && (addr < (0x30000000 + 0x20000))) {
|
|
printf("Reset addr : %0X \r\n",addr);
|
|
} else {
|
|
printf("Reset addr : %0X \r\n",addr);
|
|
return 0;
|
|
}
|
|
|
|
return 1;
|
|
}
|
|
|
|
int FLASH_If_Erase(uint32_t size)
|
|
{
|
|
int start_sector = IAP_START_SECTOR;
|
|
int num = size / 4096;
|
|
if (size % 4096) {
|
|
num++;
|
|
}
|
|
for (int i = 0; i < num; ++i) {
|
|
W25QXX_Erase_Sector((start_sector + i) * 4096);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
int FLASH_If_verify(uint32_t addr, uint8_t *pucSrc, uint32_t ulLen)
|
|
{
|
|
static uint8_t aucbuf[1024];
|
|
int start_sector = IAP_START_SECTOR;
|
|
|
|
addr = addr + start_sector * 4096;
|
|
|
|
while (ulLen >= 256) {
|
|
W25QXX_Read(aucbuf, addr, 256);
|
|
if (memcmp(aucbuf, pucSrc, 256) != 0) {
|
|
printf("verify failed at 0x%08X\n", addr);
|
|
return -1;
|
|
}
|
|
pucSrc += 256;
|
|
addr += 256;
|
|
ulLen -= 256;
|
|
}
|
|
|
|
if (ulLen > 0) {
|
|
W25QXX_Read(aucbuf, addr, ulLen);
|
|
if (memcmp(aucbuf, pucSrc, ulLen) != 0) {
|
|
printf("verify failed at 0x%08X\n", addr);
|
|
return -1;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int FLASH_If_Write(uint32_t addr, uint8_t *pucSrc, uint32_t ulLen)
|
|
{
|
|
int start_sector = IAP_START_SECTOR;
|
|
|
|
addr = addr + start_sector * 4096;
|
|
|
|
while (ulLen >= 256) {
|
|
W25QXX_Page_Program(pucSrc, addr, 256);
|
|
pucSrc += 256;
|
|
addr += 256;
|
|
ulLen -= 256;
|
|
}
|
|
|
|
if (ulLen > 0) {
|
|
W25QXX_Page_Program(pucSrc, addr, ulLen);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int iapPacketHandler(const uint8_t *packet)
|
|
{
|
|
iapPacketDef *pkt = (iapPacketDef *)packet;
|
|
switch (pkt->ucCmd) {
|
|
case IAP_CMD_ERASE:
|
|
{
|
|
uint32_t len = pkt->aulParams[0];
|
|
if (len > 0) {
|
|
FLASH_If_Erase(len);
|
|
char *str = "erase success";
|
|
cpy_prot_send_packet( CPY_PROT_CMD_IAP | CPY_PROT_CMD_ACK, (uint8_t *)str, strlen(str));
|
|
} else {
|
|
char *str = "erase failed";
|
|
cpy_prot_send_packet( CPY_PROT_CMD_IAP | CPY_PROT_CMD_ERROR, (uint8_t *)str, strlen(str));
|
|
}
|
|
}
|
|
break;
|
|
case IAP_CMD_WRITE:
|
|
{
|
|
uint32_t addr = pkt->aulParams[0];
|
|
uint32_t len = pkt->aulParams[1];
|
|
int ret = FLASH_If_Write(addr, pkt->data, len);
|
|
ret = FLASH_If_verify(addr, pkt->data, len);
|
|
if (ret == 0) {
|
|
printf("write success at %d\n", addr);
|
|
char *str = "write success";
|
|
cpy_prot_send_packet( CPY_PROT_CMD_IAP | CPY_PROT_CMD_ACK, (uint8_t *)str, strlen(str));
|
|
} else {
|
|
printf("write failed at %d\n", addr);
|
|
char *str = "write failed";
|
|
cpy_prot_send_packet( CPY_PROT_CMD_IAP | CPY_PROT_CMD_ERROR, (uint8_t *)str, strlen(str));
|
|
}
|
|
}
|
|
break;
|
|
case IAP_CMD_CHECK:
|
|
{
|
|
|
|
}
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
#ifdef BOOTLOADER
|
|
static int bootBlockingFlag = 0;
|
|
void blockInBootloader(int block)
|
|
{
|
|
if (block) {
|
|
bootBlockingFlag = 1;
|
|
} else {
|
|
bootBlockingFlag = 0;
|
|
}
|
|
|
|
static uint32_t val;
|
|
W25QXX_Read((uint8_t *)&val, IAP_START_SECTOR * 4096, 4);
|
|
printf("0x%08X \n", val);
|
|
}
|
|
#endif
|
|
|
|
int giIapThreadStatus = 0;
|
|
|
|
static void iapThread(void *arg)
|
|
{
|
|
|
|
printf("iapThread running ... \r\n");
|
|
|
|
osDelay(3000);
|
|
|
|
#ifdef BOOTLOADER
|
|
while(1) {
|
|
if (bootBlockingFlag == 0) {
|
|
if (checkApp()) {
|
|
appJump();
|
|
}
|
|
}
|
|
osDelay(1000);
|
|
}
|
|
#else
|
|
while(1) {
|
|
osDelay(1000);
|
|
}
|
|
#endif
|
|
|
|
}
|
|
|
|
void iapThreadInit(void)
|
|
{
|
|
const osThreadAttr_t Task_attributes = {
|
|
.name = "iap_thread",
|
|
.stack_size = 4096 * 4,
|
|
.priority = (osPriority_t) osPriorityNormal,
|
|
};
|
|
if (osThreadNew(iapThread, NULL, &Task_attributes) == NULL)
|
|
{
|
|
printf("failed to create iap_thread\n");
|
|
}
|
|
}
|