| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354 |
- /*
- * Copyright (c) 2006-2021, RT-Thread Development Team
- *
- * SPDX-License-Identifier: Apache-2.0
- *
- * Change Logs:
- * Date Author Notes
- * 2022-02-12 19813 the first version
- */
- #define App_Addr 0x08008000
- #define ef_flag_addr 0x130000
- #define App_size 96
- #include "stm32g0xx_hal.h"
- #include "stm32g0xx_hal_flash_ex.h"
- #include "stm32g0xx_hal_flash.h"
- #include "main.h"
- #include "string.h"
- #include "iap.h"
- #include "wwdg.h"
- #include "driver_spiflash.h"
- #include <rtthread.h>
- char cache[8];
- uint8_t buf[1024] = {0};
- uint8_t cache_buf[1024] = {0};
- ///
- ///
- /// 将现有的app区域固件拷贝到bak2中 作为底层固件备份
- ///
- /// par bak_num: 选择备份空间
- /// bak_num = 100 备份空间1 该空间中存放经10次开机验证无问题的固件 第十次开机时从app拷贝而来
- /// bak_num = 200 备份空间2 该空间中存放首次烧录的固件 第二次开机时从app拷贝而来
- ///
- ///
- uint8_t copy_app_to_bak(uint8_t bak_num)
- {
- uint16_t i = 0, j = 0;
- uint8_t res = 0;
- uint32_t bak_addr = 0;
- uint32_t app_address = App_Addr;
- // rt_kprintf("\r\ncopy_app_to_bak\r\n");
- if (bak_num == 100)
- {
- bak_addr = 0x140000;
- res = 1;
- }
- else if (bak_num == 200)
- {
- bak_addr = 0x180000;
- res = 1;
- }
- else
- {
- return 0;
- }
- for (j = 0; j < App_size; j++)
- {
- memset(buf, 0, 1024);
- for (i = 0; i < 1024; i++)
- {
- cache[0] = 0;
- cache[1] = 0;
- rt_sprintf(cache, "%02X", *(__IO uint8_t *)(app_address + i));
- HexStrToByte(cache, i, 2);
- }
- if ((bak_addr + j * 1024) % 4096 == 0)
- {
- SPI_FLASH_SectorErase(bak_addr + j * 1024);
- }
- SPI_FLASH_BufferWrite(buf, bak_addr + j * 1024, 1024);
- app_address += 0x400;
- rt_kprintf("app -> bak%d :%d/%d\r\n",bak_num, j + 1, App_size);
- }
- return res;
- }
- ///
- ///
- ///
- ///
- /// @param bak_num 选择使用哪个备份空间进行还原
- ///
- /// @return 结果
- ///
- ///
- ///
- ///
- uint8_t write_app_from_bak(uint8_t bak_num)
- {
- uint8_t res = 0;
- uint16_t i = 0;
- uint32_t bak_addr = 0;
- uint16_t lenght = 1024;
- switch (bak_num)
- {
- case 50:
- // rt_kprintf("IAP");
- bak_addr = 0x100000;
- res = 1;
- break;
- case 100:
- // rt_kprintf("BAK1");
- bak_addr = 0x140000;
- res = 1;
- break;
- case 200:
- // rt_kprintf("BAK2");
- bak_addr = 0x180000;
- res = 1;
- break;
- default:
- res = 0;
- break;
- }
- if (res == 1)
- {
- // rt_kprintf(" ---> App\r\n");
- for (i = 0; i < App_size * 1024 / lenght; i++)
- {
- memset(buf, 0, lenght);
- SPI_FLASH_BufferRead(buf, bak_addr + i * lenght, lenght);
- if(i % 2 == 0)
- MyErase_page(App_Addr + i * lenght, 1);
- if (ucMCU_FlashWrite_WithAddr(App_Addr + i * lenght, buf, 1024) == 1)
- {
- rt_kprintf("%d -> App :%d/%d\r\n",bak_num, i + 1, App_size * 1024 / lenght);
- }
- }
- }
- return res;
- }
- void HexStrToByte(const char *source, int sourceLen, uint8_t datalen)
- {
- ///传入的十六进制需要是大写的 如0xF1 大小写的差值不一样
- short i;
- unsigned char highByte, lowByte;
- // static uint8_t flag_pianyi = 0; //位移标记位 用于将4字节 反向排序
- ///
- ///
- /// 从stm32 内部flash中读出来的时候 已经是小端模式 只需要无脑的全拿出来和全写进去就行了
- ///
- ///
- for (i = 0; i < datalen; i += 2)
- {
- highByte = source[i];
- lowByte = source[i + 1];
- // rt_kprintf("high is %d , low is %d\r\n",highByte,lowByte);
- if (highByte > 64) //这里判断的是将A-F转换为0XA到0XF ,查看ASCII 表,可以看到从字符转换到hex之间的 差值
- highByte -= 55;
- else
- highByte -= 48;
- if (lowByte > 64) //这里是将0-9转换为0x0-0x9 同样查看ASCII表,可以看到从字符准换到hex之间的差值。
- lowByte -= 55;
- else
- lowByte -= 48;
- buf[sourceLen] = (highByte << 4) | lowByte;
- }
- return;
- }
- void rt_kprintf_spi_flash(uint32_t addr, uint16_t lenght)
- {
- uint16_t i = 0;
- // rt_kprintf("\r\nspi_flash 0x%06X lenght %d\r\n", addr, lenght);
- memset(cache_buf, 0, 1024);
- SPI_FLASH_BufferRead(cache_buf, addr, lenght);
- for (i = 0; i < lenght; i++)
- {
- rt_kprintf("%02X ", cache_buf[i]);
- if ((i + 1) % 16 == 0)
- {
- rt_kprintf("\r\n");
- }
- if ((i + 1) % 128 == 0)
- {
- rt_kprintf("\r\n");
- }
- }
- }
- void rt_kprintf_onchip_flash(uint32_t addr, uint16_t lenght)
- {
- uint16_t i = 0;
- // rt_kprintf("\r\nmcu_flash addr 0x%08X lenght %d\r\n", addr, lenght);
- memset(cache_buf, 0, 1024);
- for (i = 0; i < lenght; i++)
- {
- rt_kprintf("0x%02X ", *(__IO uint8_t *)(addr + i));
- if ((i + 1) % 16 == 0)
- {
- rt_kprintf("\r\n");
- }
- if ((i + 1) % 128 == 0)
- {
- rt_kprintf("\r\n");
- }
- }
- }
- uint8_t ucMCU_FlashWrite_WithAddr(uint32_t FlashAddr, uint8_t *pSrcAddr, uint16_t uiDataLen)
- ///参考 https://blog.csdn.net/errorhai/article/details/82499326
- {
- uint8_t ucErrSta, ucByteAlign;
- uint16_t uiLen;
- uint8_t state = 0;
- uint64_t ps, tmp;
- ucErrSta = 1;
- __disable_irq();
- HAL_FLASH_Unlock(); //解锁
- __HAL_FLASH_CLEAR_FLAG(FLASH_FLAG_OPTVERR); //清标志位
- uiLen = 0;
- while (uiLen < uiDataLen)
- {
- ps = 0;
- for (ucByteAlign = 0; ucByteAlign < 8; ucByteAlign++)
- {
- tmp = (uint64_t)(pSrcAddr[ucByteAlign + uiLen]);
- ps += (tmp << (ucByteAlign * 8));
- }
- state = HAL_FLASH_Program(FLASH_TYPEPROGRAM_DOUBLEWORD, FlashAddr, ps);
- if (state != HAL_OK)
- {
- rt_kprintf("mcu write fail");
- ucErrSta = 0;
- break;
- }
- FlashAddr += 8;
- uiLen += 8;
- }
- HAL_FLASH_Lock(); //上锁
- __enable_irq();
- return (ucErrSta);
- }
- void MyErase_page(uint32_t pageaddr, uint32_t num)
- {
- uint32_t PageError = 0;
- HAL_FLASH_Unlock();
- /* 擦除FLASH*/
- FLASH_EraseInitTypeDef FlashSet;
- FlashSet.TypeErase = FLASH_TYPEERASE_PAGES; //页编辑
- FlashSet.Page = pageaddr / 2048; //从哪一页开始
- FlashSet.NbPages = num; //擦除页数
- //__HAL_FLASH_CLEAR_FLAG(FLASH_FLAG_OPTVERR);//清除标志位
- /*设置PageError,调用擦除函数*/
- HAL_FLASHEx_Erase(&FlashSet, &PageError);
- HAL_FLASH_Lock();
- }
- #define THREAD_PRIORITY 6
- #define THREAD_STACK_SIZE 2048
- #define THREAD_TIMESLICE 5
- extern WWDG_HandleTypeDef hwwdg;
- ///
- ///
- ///
- /// Bootloader watch dog
- ///
- /// 使用070内部WWDG作为看门狗
- ///
- ///
- ///
- ///
- extern uint8_t easyflash_init_finsh;
- static void Guard_service_task(void *param)
- {
- uint16_t count = 0, countdown = 360,count1 = 0;
- while(easyflash_init_finsh == Zero)
- {
- rt_thread_mdelay(100);
- count1++;
- if(count1 >= 100)
- {
- break;
- }
- }
- rt_kprintf("wwdg Run\r\n");
- MX_WWDG_Init();
- // rt_kprintf("jump wwdg");
- while (1)
- {
- HAL_WWDG_Refresh(&hwwdg);
- count++;
- rt_thread_mdelay(100);
- if (count > countdown)
- {
- break;
- }
- if (count % (countdown / 5) == 0)
- {
- rt_kprintf("wwdg C/D...%d/%ds\r\n", countdown / 10 - count / 10, countdown / 10);
- }
- }
- }
- int guard_service_thread(void)
- {
- rt_thread_t tid1 = RT_NULL;
- //此处优先级比main高1 就不需要到处喂狗了
- tid1 = rt_thread_create("Guard_service_task",
- Guard_service_task, RT_NULL,
- 2048,
- 6, 5);
- if (tid1 != RT_NULL)
- {
- rt_thread_startup(tid1);
- }
- return 0;
- }
- INIT_APP_EXPORT(guard_service_thread); // Guard服务线程
|