cfg.c 1.6 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273
  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->lock_threshold = 0.0;
  13. config->lock_threshold = 0.0;
  14. //config->App2Size = 0;
  15. //config->App2Crc = 0;
  16. //config->IapFlag = 0;
  17. }
  18. int Config_Init(void)
  19. {
  20. //EFLASH_StatusType ret = EFLASH_STATUS_SUCCESS;
  21. memcpy(reflectionBuff, (void *)CONFIG_ADDRESS, sizeof(Config_type));
  22. if (config->magic != CONFIG_MAGIC)
  23. {/* initiliaze config */
  24. memset(reflectionBuff, 0xFF, sizeof(Config_type));
  25. //config->magic = CONFIG_MAGIC;
  26. Factory_reset();
  27. //
  28. config->IapFlag = Startup_Normal;
  29. config->hw_version = 0x0000;
  30. config->devicetype = 0x0000;
  31. config->deviceid = 0x00;
  32. SaveConfig();
  33. }
  34. //Factory_reset();
  35. return 0;
  36. }
  37. int SaveConfig(void)
  38. {
  39. EFLASH_StatusType ret = EFLASH_STATUS_SUCCESS;
  40. EFLASH_UnlockCtrl();
  41. ret = EFLASH_PageErase(CONFIG_ADDRESS); ///<erase page
  42. if (ret != EFLASH_STATUS_SUCCESS) return -1;
  43. ret = EFLASH_PageEraseVerify(CONFIG_ADDRESS); ///< verify erase state
  44. if (ret != EFLASH_STATUS_SUCCESS) return -1;
  45. ret = EFLASH_PageProgram(CONFIG_ADDRESS, (uint32_t *)reflectionBuff, (sizeof(Config_type)>>2)+1); ///<
  46. if (ret != EFLASH_STATUS_SUCCESS) return -1;
  47. EFLASH_LockCtrl();
  48. return 0;
  49. }
  50. int ResetConfig(void)
  51. {
  52. Factory_reset();
  53. //SaveConfig();
  54. return 0;
  55. }