cfg.c 1.6 KB

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