wifi_store.c 3.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157
  1. /* Saved WiFi networks: a small fixed-capacity list in one 8.3 FAT file.
  2. * Everything is read/written whole; the network menu and the boot helper
  3. * both go through this module. */
  4. #include "ucmd_lib.h"
  5. #include "wifi_store.h"
  6. #define CFG_SLACK 512 /* FAT may write a final partial sector */
  7. static void wipe(void *p, unsigned int n)
  8. {
  9. volatile unsigned char *b = (volatile unsigned char *)p;
  10. while (n--)
  11. *b++ = 0;
  12. }
  13. static int cfg_valid(const struct wifi_cfg *c)
  14. {
  15. return c->magic == WIFI_CFG_MAGIC && c->ssid_len >= 1 &&
  16. c->ssid_len <= 32 && c->pass_len <= 64;
  17. }
  18. int wifi_store_find(const struct wifi_cfg *list, int count,
  19. const unsigned char *ssid, unsigned int ssid_len)
  20. {
  21. int i;
  22. if (!list || !ssid || ssid_len == 0 || ssid_len > 32)
  23. return -1;
  24. for (i = 0; i < count; i++) {
  25. unsigned int j;
  26. if (list[i].ssid_len != ssid_len)
  27. continue;
  28. for (j = 0; j < ssid_len; j++)
  29. if (list[i].ssid[j] != ssid[j])
  30. break;
  31. if (j == ssid_len)
  32. return i;
  33. }
  34. return -1;
  35. }
  36. int wifi_store_load(struct wifi_cfg *out, int max)
  37. {
  38. union {
  39. struct wifi_cfg_list list;
  40. struct wifi_cfg one;
  41. unsigned char raw[sizeof(struct wifi_cfg_list) + CFG_SLACK];
  42. } buf;
  43. int r, n = 0, i;
  44. if (!out || max <= 0)
  45. return 0;
  46. r = u_syscall3(SYS_READ_FILE, (int)WIFI_CRED_PATH, (int)buf.raw,
  47. (int)sizeof(buf.raw));
  48. if (r >= 4 && buf.list.magic == WIFI_CFG_LIST_MAGIC) {
  49. int count;
  50. if (r < 12 || buf.list.version != WIFI_CFG_LIST_VER)
  51. goto done;
  52. count = (int)buf.list.count;
  53. if (count > WIFI_CFG_MAX)
  54. count = WIFI_CFG_MAX;
  55. if ((unsigned int)r < 12u +
  56. (unsigned int)count * sizeof(struct wifi_cfg))
  57. count = (r - 12) / (int)sizeof(struct wifi_cfg);
  58. for (i = 0; i < count && n < max; i++) {
  59. const struct wifi_cfg *c = &buf.list.net[i];
  60. if (!cfg_valid(c))
  61. continue;
  62. if (wifi_store_find(out, n, c->ssid, c->ssid_len) >= 0)
  63. continue;
  64. out[n++] = *c;
  65. }
  66. } else if (r >= (int)sizeof(struct wifi_cfg) && cfg_valid(&buf.one)) {
  67. out[0] = buf.one;
  68. n = 1;
  69. }
  70. done:
  71. wipe(buf.raw, sizeof(buf.raw));
  72. return n;
  73. }
  74. int wifi_store_save(const struct wifi_cfg *list, int count)
  75. {
  76. union {
  77. struct wifi_cfg_list list;
  78. unsigned char raw[sizeof(struct wifi_cfg_list) + CFG_SLACK];
  79. } buf;
  80. unsigned int len;
  81. int i, r;
  82. if (!list || count <= 0) {
  83. u_syscall1(SYS_UNLINK, (int)WIFI_CRED_PATH);
  84. return 0;
  85. }
  86. if (count > WIFI_CFG_MAX)
  87. count = WIFI_CFG_MAX;
  88. wipe(buf.raw, sizeof(buf.raw));
  89. buf.list.magic = WIFI_CFG_LIST_MAGIC;
  90. buf.list.version = WIFI_CFG_LIST_VER;
  91. buf.list.count = (unsigned int)count;
  92. for (i = 0; i < count; i++)
  93. buf.list.net[i] = list[i];
  94. len = 12u + (unsigned int)count * sizeof(struct wifi_cfg);
  95. r = u_syscall3(SYS_WRITE_FILE, (int)WIFI_CRED_PATH, (int)buf.raw,
  96. (int)len);
  97. wipe(buf.raw, sizeof(buf.raw));
  98. return r == 0 ? 0 : -1;
  99. }
  100. int wifi_store_remember(const struct wifi_cfg *rec)
  101. {
  102. struct wifi_cfg list[WIFI_CFG_MAX];
  103. int n, i, idx, r;
  104. if (!rec || !cfg_valid(rec))
  105. return -1;
  106. n = wifi_store_load(list, WIFI_CFG_MAX);
  107. idx = wifi_store_find(list, n, rec->ssid, rec->ssid_len);
  108. if (idx >= 0) {
  109. for (i = idx; i + 1 < n; i++)
  110. list[i] = list[i + 1];
  111. n--;
  112. }
  113. if (n >= WIFI_CFG_MAX)
  114. n = WIFI_CFG_MAX - 1; /* drop the least recently used */
  115. for (i = n; i > 0; i--)
  116. list[i] = list[i - 1];
  117. list[0] = *rec;
  118. list[0].magic = WIFI_CFG_MAGIC;
  119. r = wifi_store_save(list, n + 1);
  120. wipe(list, sizeof(list));
  121. return r;
  122. }
  123. int wifi_store_forget(const unsigned char *ssid, unsigned int ssid_len)
  124. {
  125. struct wifi_cfg list[WIFI_CFG_MAX];
  126. int n, i, idx, r;
  127. n = wifi_store_load(list, WIFI_CFG_MAX);
  128. idx = wifi_store_find(list, n, ssid, ssid_len);
  129. if (idx < 0) {
  130. wipe(list, sizeof(list));
  131. return 0;
  132. }
  133. for (i = idx; i + 1 < n; i++)
  134. list[i] = list[i + 1];
  135. n--;
  136. r = wifi_store_save(list, n) == 0 ? 1 : -1;
  137. wipe(list, sizeof(list));
  138. return r;
  139. }