cfg.c 1.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263
  1. #include "cfg.h"
  2. #include "uart.h"
  3. #include "ac780x_eflash.h"
  4. #include <string.h>
  5. static uint32_t reflectionBuff[(sizeof(Config_type)>>2)+1];
  6. Config_type *config = (Config_type *)reflectionBuff;
  7. static void Factory_reset(void)
  8. {
  9. config->magic = CONFIG_MAGIC;
  10. config->addr = DEFAULT_ADDR;
  11. config->br_index = BaudRate_9600;
  12. config->AppSize = 0;
  13. config->AppCrc = 0;
  14. }
  15. int Config_Init(void)
  16. {
  17. //EFLASH_StatusType ret = EFLASH_STATUS_SUCCESS;
  18. memcpy(reflectionBuff, (void *)CONFIG_ADDRESS, sizeof(Config_type));
  19. if (config->magic != CONFIG_MAGIC)
  20. {/* initiliaze config */
  21. memset(reflectionBuff, 0, sizeof(Config_type));
  22. //config->magic = CONFIG_MAGIC;
  23. Factory_reset();
  24. SaveConfig();
  25. }
  26. //Factory_reset();
  27. return 0;
  28. }
  29. int SaveConfig(void)
  30. {
  31. EFLASH_StatusType ret = EFLASH_STATUS_SUCCESS;
  32. EFLASH_UnlockCtrl();
  33. ret = EFLASH_PageErase(CONFIG_ADDRESS); ///<erase page
  34. if (ret != EFLASH_STATUS_SUCCESS) return -1;
  35. ret = EFLASH_PageEraseVerify(CONFIG_ADDRESS); ///< verify erase state
  36. if (ret != EFLASH_STATUS_SUCCESS) return -1;
  37. ret = EFLASH_PageProgram(CONFIG_ADDRESS, (uint32_t *)reflectionBuff, (sizeof(Config_type)>>2)+1); ///<
  38. if (ret != EFLASH_STATUS_SUCCESS) return -1;
  39. EFLASH_LockCtrl();
  40. return 0;
  41. }
  42. int ResetConfig(void)
  43. {
  44. Factory_reset();
  45. //SaveConfig();
  46. return 0;
  47. }