iap.c 8.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354
  1. /*
  2. * Copyright (c) 2006-2021, RT-Thread Development Team
  3. *
  4. * SPDX-License-Identifier: Apache-2.0
  5. *
  6. * Change Logs:
  7. * Date Author Notes
  8. * 2022-02-12 19813 the first version
  9. */
  10. #define App_Addr 0x08008000
  11. #define ef_flag_addr 0x130000
  12. #define App_size 96
  13. #include "stm32g0xx_hal.h"
  14. #include "stm32g0xx_hal_flash_ex.h"
  15. #include "stm32g0xx_hal_flash.h"
  16. #include "main.h"
  17. #include "string.h"
  18. #include "iap.h"
  19. #include "wwdg.h"
  20. #include "driver_spiflash.h"
  21. #include <rtthread.h>
  22. char cache[8];
  23. uint8_t buf[1024] = {0};
  24. uint8_t cache_buf[1024] = {0};
  25. ///
  26. ///
  27. /// 将现有的app区域固件拷贝到bak2中 作为底层固件备份
  28. ///
  29. /// par bak_num: 选择备份空间
  30. /// bak_num = 100 备份空间1 该空间中存放经10次开机验证无问题的固件 第十次开机时从app拷贝而来
  31. /// bak_num = 200 备份空间2 该空间中存放首次烧录的固件 第二次开机时从app拷贝而来
  32. ///
  33. ///
  34. uint8_t copy_app_to_bak(uint8_t bak_num)
  35. {
  36. uint16_t i = 0, j = 0;
  37. uint8_t res = 0;
  38. uint32_t bak_addr = 0;
  39. uint32_t app_address = App_Addr;
  40. // rt_kprintf("\r\ncopy_app_to_bak\r\n");
  41. if (bak_num == 100)
  42. {
  43. bak_addr = 0x140000;
  44. res = 1;
  45. }
  46. else if (bak_num == 200)
  47. {
  48. bak_addr = 0x180000;
  49. res = 1;
  50. }
  51. else
  52. {
  53. return 0;
  54. }
  55. for (j = 0; j < App_size; j++)
  56. {
  57. memset(buf, 0, 1024);
  58. for (i = 0; i < 1024; i++)
  59. {
  60. cache[0] = 0;
  61. cache[1] = 0;
  62. rt_sprintf(cache, "%02X", *(__IO uint8_t *)(app_address + i));
  63. HexStrToByte(cache, i, 2);
  64. }
  65. if ((bak_addr + j * 1024) % 4096 == 0)
  66. {
  67. SPI_FLASH_SectorErase(bak_addr + j * 1024);
  68. }
  69. SPI_FLASH_BufferWrite(buf, bak_addr + j * 1024, 1024);
  70. app_address += 0x400;
  71. rt_kprintf("app -> bak%d :%d/%d\r\n",bak_num, j + 1, App_size);
  72. }
  73. return res;
  74. }
  75. ///
  76. ///
  77. ///
  78. ///
  79. /// @param bak_num 选择使用哪个备份空间进行还原
  80. ///
  81. /// @return 结果
  82. ///
  83. ///
  84. ///
  85. ///
  86. uint8_t write_app_from_bak(uint8_t bak_num)
  87. {
  88. uint8_t res = 0;
  89. uint16_t i = 0;
  90. uint32_t bak_addr = 0;
  91. uint16_t lenght = 1024;
  92. switch (bak_num)
  93. {
  94. case 50:
  95. // rt_kprintf("IAP");
  96. bak_addr = 0x100000;
  97. res = 1;
  98. break;
  99. case 100:
  100. // rt_kprintf("BAK1");
  101. bak_addr = 0x140000;
  102. res = 1;
  103. break;
  104. case 200:
  105. // rt_kprintf("BAK2");
  106. bak_addr = 0x180000;
  107. res = 1;
  108. break;
  109. default:
  110. res = 0;
  111. break;
  112. }
  113. if (res == 1)
  114. {
  115. // rt_kprintf(" ---> App\r\n");
  116. for (i = 0; i < App_size * 1024 / lenght; i++)
  117. {
  118. memset(buf, 0, lenght);
  119. SPI_FLASH_BufferRead(buf, bak_addr + i * lenght, lenght);
  120. if(i % 2 == 0)
  121. MyErase_page(App_Addr + i * lenght, 1);
  122. if (ucMCU_FlashWrite_WithAddr(App_Addr + i * lenght, buf, 1024) == 1)
  123. {
  124. rt_kprintf("%d -> App :%d/%d\r\n",bak_num, i + 1, App_size * 1024 / lenght);
  125. }
  126. }
  127. }
  128. return res;
  129. }
  130. void HexStrToByte(const char *source, int sourceLen, uint8_t datalen)
  131. {
  132. ///传入的十六进制需要是大写的 如0xF1 大小写的差值不一样
  133. short i;
  134. unsigned char highByte, lowByte;
  135. // static uint8_t flag_pianyi = 0; //位移标记位 用于将4字节 反向排序
  136. ///
  137. ///
  138. /// 从stm32 内部flash中读出来的时候 已经是小端模式 只需要无脑的全拿出来和全写进去就行了
  139. ///
  140. ///
  141. for (i = 0; i < datalen; i += 2)
  142. {
  143. highByte = source[i];
  144. lowByte = source[i + 1];
  145. // rt_kprintf("high is %d , low is %d\r\n",highByte,lowByte);
  146. if (highByte > 64) //这里判断的是将A-F转换为0XA到0XF ,查看ASCII 表,可以看到从字符转换到hex之间的 差值
  147. highByte -= 55;
  148. else
  149. highByte -= 48;
  150. if (lowByte > 64) //这里是将0-9转换为0x0-0x9 同样查看ASCII表,可以看到从字符准换到hex之间的差值。
  151. lowByte -= 55;
  152. else
  153. lowByte -= 48;
  154. buf[sourceLen] = (highByte << 4) | lowByte;
  155. }
  156. return;
  157. }
  158. void rt_kprintf_spi_flash(uint32_t addr, uint16_t lenght)
  159. {
  160. uint16_t i = 0;
  161. // rt_kprintf("\r\nspi_flash 0x%06X lenght %d\r\n", addr, lenght);
  162. memset(cache_buf, 0, 1024);
  163. SPI_FLASH_BufferRead(cache_buf, addr, lenght);
  164. for (i = 0; i < lenght; i++)
  165. {
  166. rt_kprintf("%02X ", cache_buf[i]);
  167. if ((i + 1) % 16 == 0)
  168. {
  169. rt_kprintf("\r\n");
  170. }
  171. if ((i + 1) % 128 == 0)
  172. {
  173. rt_kprintf("\r\n");
  174. }
  175. }
  176. }
  177. void rt_kprintf_onchip_flash(uint32_t addr, uint16_t lenght)
  178. {
  179. uint16_t i = 0;
  180. // rt_kprintf("\r\nmcu_flash addr 0x%08X lenght %d\r\n", addr, lenght);
  181. memset(cache_buf, 0, 1024);
  182. for (i = 0; i < lenght; i++)
  183. {
  184. rt_kprintf("0x%02X ", *(__IO uint8_t *)(addr + i));
  185. if ((i + 1) % 16 == 0)
  186. {
  187. rt_kprintf("\r\n");
  188. }
  189. if ((i + 1) % 128 == 0)
  190. {
  191. rt_kprintf("\r\n");
  192. }
  193. }
  194. }
  195. uint8_t ucMCU_FlashWrite_WithAddr(uint32_t FlashAddr, uint8_t *pSrcAddr, uint16_t uiDataLen)
  196. ///参考 https://blog.csdn.net/errorhai/article/details/82499326
  197. {
  198. uint8_t ucErrSta, ucByteAlign;
  199. uint16_t uiLen;
  200. uint8_t state = 0;
  201. uint64_t ps, tmp;
  202. ucErrSta = 1;
  203. __disable_irq();
  204. HAL_FLASH_Unlock(); //解锁
  205. __HAL_FLASH_CLEAR_FLAG(FLASH_FLAG_OPTVERR); //清标志位
  206. uiLen = 0;
  207. while (uiLen < uiDataLen)
  208. {
  209. ps = 0;
  210. for (ucByteAlign = 0; ucByteAlign < 8; ucByteAlign++)
  211. {
  212. tmp = (uint64_t)(pSrcAddr[ucByteAlign + uiLen]);
  213. ps += (tmp << (ucByteAlign * 8));
  214. }
  215. state = HAL_FLASH_Program(FLASH_TYPEPROGRAM_DOUBLEWORD, FlashAddr, ps);
  216. if (state != HAL_OK)
  217. {
  218. rt_kprintf("mcu write fail");
  219. ucErrSta = 0;
  220. break;
  221. }
  222. FlashAddr += 8;
  223. uiLen += 8;
  224. }
  225. HAL_FLASH_Lock(); //上锁
  226. __enable_irq();
  227. return (ucErrSta);
  228. }
  229. void MyErase_page(uint32_t pageaddr, uint32_t num)
  230. {
  231. uint32_t PageError = 0;
  232. HAL_FLASH_Unlock();
  233. /* 擦除FLASH*/
  234. FLASH_EraseInitTypeDef FlashSet;
  235. FlashSet.TypeErase = FLASH_TYPEERASE_PAGES; //页编辑
  236. FlashSet.Page = pageaddr / 2048; //从哪一页开始
  237. FlashSet.NbPages = num; //擦除页数
  238. //__HAL_FLASH_CLEAR_FLAG(FLASH_FLAG_OPTVERR);//清除标志位
  239. /*设置PageError,调用擦除函数*/
  240. HAL_FLASHEx_Erase(&FlashSet, &PageError);
  241. HAL_FLASH_Lock();
  242. }
  243. #define THREAD_PRIORITY 6
  244. #define THREAD_STACK_SIZE 2048
  245. #define THREAD_TIMESLICE 5
  246. extern WWDG_HandleTypeDef hwwdg;
  247. ///
  248. ///
  249. ///
  250. /// Bootloader watch dog
  251. ///
  252. /// 使用070内部WWDG作为看门狗
  253. ///
  254. ///
  255. ///
  256. ///
  257. extern uint8_t easyflash_init_finsh;
  258. static void Guard_service_task(void *param)
  259. {
  260. uint16_t count = 0, countdown = 360,count1 = 0;
  261. while(easyflash_init_finsh == Zero)
  262. {
  263. rt_thread_mdelay(100);
  264. count1++;
  265. if(count1 >= 100)
  266. {
  267. break;
  268. }
  269. }
  270. rt_kprintf("wwdg Run\r\n");
  271. MX_WWDG_Init();
  272. // rt_kprintf("jump wwdg");
  273. while (1)
  274. {
  275. HAL_WWDG_Refresh(&hwwdg);
  276. count++;
  277. rt_thread_mdelay(100);
  278. if (count > countdown)
  279. {
  280. break;
  281. }
  282. if (count % (countdown / 5) == 0)
  283. {
  284. rt_kprintf("wwdg C/D...%d/%ds\r\n", countdown / 10 - count / 10, countdown / 10);
  285. }
  286. }
  287. }
  288. int guard_service_thread(void)
  289. {
  290. rt_thread_t tid1 = RT_NULL;
  291. //此处优先级比main高1 就不需要到处喂狗了
  292. tid1 = rt_thread_create("Guard_service_task",
  293. Guard_service_task, RT_NULL,
  294. 2048,
  295. 6, 5);
  296. if (tid1 != RT_NULL)
  297. {
  298. rt_thread_startup(tid1);
  299. }
  300. return 0;
  301. }
  302. INIT_APP_EXPORT(guard_service_thread); // Guard服务线程