cmd_arc.c 8.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408
  1. // SPDX-License-Identifier: GPL-2.0+ OR BSD-3-Clause
  2. /*
  3. * Command for accessing Arcturus factory environment.
  4. *
  5. * Copyright 2013-2019 Arcturus Networks Inc.
  6. * https://www.arcturusnetworks.com/products/
  7. * by Oleksandr G Zhadan et al.
  8. *
  9. */
  10. #include <common.h>
  11. #include <command.h>
  12. #include <cpu_func.h>
  13. #include <div64.h>
  14. #include <env.h>
  15. #include <flash.h>
  16. #include <malloc.h>
  17. #include <spi_flash.h>
  18. #include <mmc.h>
  19. #include <version.h>
  20. #include <asm/io.h>
  21. #include <linux/stringify.h>
  22. static ulong fwenv_addr[MAX_FWENV_ADDR];
  23. const char mystrerr[] = "ERROR: Failed to save factory info";
  24. static int ishwaddr(char *hwaddr)
  25. {
  26. if (strlen(hwaddr) == MAX_HWADDR_SIZE)
  27. if (hwaddr[2] == ':' &&
  28. hwaddr[5] == ':' &&
  29. hwaddr[8] == ':' &&
  30. hwaddr[11] == ':' &&
  31. hwaddr[14] == ':')
  32. return 0;
  33. return -1;
  34. }
  35. #if (FWENV_TYPE == FWENV_MMC)
  36. static char smac[29][18] __attribute__ ((aligned(0x200))); /* 1 MMC block is 512 bytes */
  37. int set_mmc_arc_product(int argc, char *const argv[])
  38. {
  39. struct mmc *mmc;
  40. u32 blk, cnt, n;
  41. int i, err = 1;
  42. void *addr;
  43. const u8 mmc_dev_num = CONFIG_SYS_MMC_ENV_DEV;
  44. mmc = find_mmc_device(mmc_dev_num);
  45. if (!mmc) {
  46. printf("No SD/MMC/eMMC card found\n");
  47. return 0;
  48. }
  49. if (mmc_init(mmc)) {
  50. printf("%s(%d) init failed\n", IS_SD(mmc) ? "SD" : "MMC",
  51. mmc_dev_num);
  52. return 0;
  53. }
  54. if (mmc_getwp(mmc) == 1) {
  55. printf("Error: card is write protected!\n");
  56. return CMD_RET_FAILURE;
  57. }
  58. /* Save factory defaults */
  59. addr = (void *)smac;
  60. cnt = 1; /* One 512 bytes block */
  61. for (i = 0; i < MAX_FWENV_ADDR; i++)
  62. if (fwenv_addr[i] != -1) {
  63. blk = fwenv_addr[i] / 512;
  64. n = blk_dwrite(mmc_get_blk_desc(mmc), blk, cnt, addr);
  65. if (n != cnt)
  66. printf("%s: %s [%d]\n", __func__, mystrerr, i);
  67. else
  68. err = 0;
  69. }
  70. if (err)
  71. return -2;
  72. return err;
  73. }
  74. static int read_mmc_arc_info(void)
  75. {
  76. struct mmc *mmc;
  77. u32 blk, cnt, n;
  78. int i;
  79. void *addr;
  80. const u8 mmc_dev_num = CONFIG_SYS_MMC_ENV_DEV;
  81. mmc = find_mmc_device(mmc_dev_num);
  82. if (!mmc) {
  83. printf("No SD/MMC/eMMC card found\n");
  84. return 0;
  85. }
  86. if (mmc_init(mmc)) {
  87. printf("%s(%d) init failed\n", IS_SD(mmc) ? "SD" : "MMC",
  88. mmc_dev_num);
  89. return 0;
  90. }
  91. addr = (void *)smac;
  92. cnt = 1; /* One 512 bytes block */
  93. for (i = 0; i < MAX_FWENV_ADDR; i++)
  94. if (fwenv_addr[i] != -1) {
  95. blk = fwenv_addr[i] / 512;
  96. n = blk_dread(mmc_get_blk_desc(mmc), blk, cnt, addr);
  97. flush_cache((ulong) addr, 512);
  98. if (n == cnt)
  99. return (i + 1);
  100. }
  101. return 0;
  102. }
  103. #endif
  104. #if (FWENV_TYPE == FWENV_SPI_FLASH)
  105. static struct spi_flash *flash;
  106. static char smac[4][18];
  107. int set_spi_arc_product(int argc, char *const argv[])
  108. {
  109. int i, err = 1;
  110. flash = spi_flash_probe(CONFIG_ENV_SPI_BUS, CONFIG_ENV_SPI_CS,
  111. CONFIG_ENV_SPI_MAX_HZ, CONFIG_ENV_SPI_MODE);
  112. if (!flash) {
  113. printf("Failed to initialize SPI flash at %u:%u\n",
  114. CONFIG_ENV_SPI_BUS, CONFIG_ENV_SPI_CS);
  115. return -1;
  116. }
  117. /* Save factory defaults */
  118. for (i = 0; i < MAX_FWENV_ADDR; i++)
  119. if (fwenv_addr[i] != -1)
  120. if (spi_flash_write
  121. (flash, fwenv_addr[i], sizeof(smac), smac))
  122. printf("%s: %s [%d]\n", __func__, mystrerr, i);
  123. else
  124. err = 0;
  125. if (err)
  126. return -2;
  127. return err;
  128. }
  129. static int read_spi_arc_info(void)
  130. {
  131. int i;
  132. flash = spi_flash_probe(CONFIG_ENV_SPI_BUS, CONFIG_ENV_SPI_CS,
  133. CONFIG_ENV_SPI_MAX_HZ, CONFIG_ENV_SPI_MODE);
  134. if (!flash) {
  135. printf("Failed to initialize SPI flash at %u:%u\n",
  136. CONFIG_ENV_SPI_BUS, CONFIG_ENV_SPI_CS);
  137. return 0;
  138. }
  139. for (i = 0; i < MAX_FWENV_ADDR; i++)
  140. if (fwenv_addr[i] != -1)
  141. if (!spi_flash_read
  142. (flash, fwenv_addr[i], sizeof(smac), smac))
  143. return (i + 1);
  144. return 0;
  145. }
  146. #endif
  147. #if (FWENV_TYPE == FWENV_NOR_FLASH)
  148. static char smac[4][18];
  149. int set_nor_arc_product(int argc, char *const argv[])
  150. {
  151. int i, err = 1;
  152. /* Save factory defaults */
  153. for (i = 0; i < MAX_FWENV_ADDR; i++)
  154. if (fwenv_addr[i] != -1) {
  155. ulong fwenv_end = fwenv_addr[i] + 4;
  156. flash_sect_roundb(&fwenv_end);
  157. flash_sect_protect(0, fwenv_addr[i], fwenv_end);
  158. if (flash_write
  159. ((char *)smac, fwenv_addr[i], sizeof(smac)))
  160. printf("%s: %s [%d]\n", __func__, mystrerr, i);
  161. else
  162. err = 0;
  163. flash_sect_protect(1, fwenv_addr[i], fwenv_end);
  164. }
  165. if (err)
  166. return -2;
  167. return err;
  168. }
  169. static int read_nor_arc_info(void)
  170. {
  171. int i;
  172. for (i = 0; i < MAX_FWENV_ADDR; i++)
  173. if (fwenv_addr[i] != -1) {
  174. memcpy(smac, (void *)fwenv_addr[i], sizeof(smac));
  175. return (i + 1);
  176. }
  177. return 0;
  178. }
  179. #endif
  180. int set_arc_product(int argc, char *const argv[])
  181. {
  182. if (argc != 5)
  183. return -1;
  184. /* Check serial number */
  185. if (strlen(argv[1]) != MAX_SERIAL_SIZE)
  186. return -1;
  187. /* Check HWaddrs */
  188. if (ishwaddr(argv[2]) || ishwaddr(argv[3]) || ishwaddr(argv[4]))
  189. return -1;
  190. strcpy(smac[0], argv[1]);
  191. strcpy(smac[1], argv[2]);
  192. strcpy(smac[2], argv[3]);
  193. strcpy(smac[3], argv[4]);
  194. #if (FWENV_TYPE == FWENV_NOR_FLASH)
  195. return set_nor_arc_product(argc, argv);
  196. #endif
  197. #if (FWENV_TYPE == FWENV_SPI_FLASH)
  198. return set_spi_arc_product(argc, argv);
  199. #endif
  200. #if (FWENV_TYPE == FWENV_MMC)
  201. return set_mmc_arc_product(argc, argv);
  202. #endif
  203. return -2;
  204. }
  205. static int read_arc_info(void)
  206. {
  207. #if (FWENV_TYPE == FWENV_NOR_FLASH)
  208. return read_nor_arc_info();
  209. #endif
  210. #if (FWENV_TYPE == FWENV_SPI_FLASH)
  211. return read_spi_arc_info();
  212. #endif
  213. #if (FWENV_TYPE == FWENV_MMC)
  214. return read_mmc_arc_info();
  215. #endif
  216. return 0;
  217. }
  218. static int do_get_arc_info(void)
  219. {
  220. int l = read_arc_info();
  221. char *oldserial = env_get("SERIAL");
  222. char *oldversion = env_get("VERSION");
  223. if (oldversion != NULL)
  224. if (strcmp(oldversion, U_BOOT_VERSION) != 0)
  225. oldversion = NULL;
  226. if (l == 0) {
  227. printf("%s: failed to read factory info\n", __func__);
  228. return -2;
  229. }
  230. printf("\rSERIAL: ");
  231. if (smac[0][0] == EMPY_CHAR) {
  232. printf("<not found>\n");
  233. } else {
  234. printf("%s\n", smac[0]);
  235. env_set("SERIAL", smac[0]);
  236. }
  237. if (strcmp(smac[1], "00:00:00:00:00:00") == 0) {
  238. env_set("ethaddr", NULL);
  239. env_set("eth1addr", NULL);
  240. env_set("eth2addr", NULL);
  241. goto done;
  242. }
  243. printf("HWADDR0: ");
  244. if (smac[1][0] == EMPY_CHAR) {
  245. printf("<not found>\n");
  246. } else {
  247. char *ret = env_get("ethaddr");
  248. if (ret == NULL) {
  249. env_set("ethaddr", smac[1]);
  250. printf("%s\n", smac[1]);
  251. } else if (strcmp(ret, __stringify(CONFIG_ETHADDR)) == 0) {
  252. env_set("ethaddr", smac[1]);
  253. printf("%s (factory)\n", smac[1]);
  254. } else {
  255. printf("%s\n", ret);
  256. }
  257. }
  258. if (strcmp(smac[2], "00:00:00:00:00:00") == 0) {
  259. env_set("eth1addr", NULL);
  260. env_set("eth2addr", NULL);
  261. goto done;
  262. }
  263. printf("HWADDR1: ");
  264. if (smac[2][0] == EMPY_CHAR) {
  265. printf("<not found>\n");
  266. } else {
  267. char *ret = env_get("eth1addr");
  268. if (ret == NULL) {
  269. env_set("ethaddr", smac[2]);
  270. printf("%s\n", smac[2]);
  271. } else if (strcmp(ret, __stringify(CONFIG_ETH1ADDR)) == 0) {
  272. env_set("eth1addr", smac[2]);
  273. printf("%s (factory)\n", smac[2]);
  274. } else {
  275. printf("%s\n", ret);
  276. }
  277. }
  278. if (strcmp(smac[3], "00:00:00:00:00:00") == 0) {
  279. env_set("eth2addr", NULL);
  280. goto done;
  281. }
  282. printf("HWADDR2: ");
  283. if (smac[3][0] == EMPY_CHAR) {
  284. printf("<not found>\n");
  285. } else {
  286. char *ret = env_get("eth2addr");
  287. if (ret == NULL) {
  288. env_set("ethaddr", smac[3]);
  289. printf("%s\n", smac[3]);
  290. } else if (strcmp(ret, __stringify(CONFIG_ETH2ADDR)) == 0) {
  291. env_set("eth2addr", smac[3]);
  292. printf("%s (factory)\n", smac[3]);
  293. } else {
  294. printf("%s\n", ret);
  295. }
  296. }
  297. done:
  298. if (oldserial == NULL || oldversion == NULL) {
  299. if (oldversion == NULL)
  300. env_set("VERSION", U_BOOT_VERSION);
  301. env_save();
  302. }
  303. return 0;
  304. }
  305. static int init_fwenv(void)
  306. {
  307. int i, ret = -1;
  308. fwenv_addr[0] = FWENV_ADDR1;
  309. fwenv_addr[1] = FWENV_ADDR2;
  310. fwenv_addr[2] = FWENV_ADDR3;
  311. fwenv_addr[3] = FWENV_ADDR4;
  312. for (i = 0; i < MAX_FWENV_ADDR; i++)
  313. if (fwenv_addr[i] != -1)
  314. ret = 0;
  315. if (ret)
  316. printf("%s: No firmfare info storage address is defined\n",
  317. __func__);
  318. return ret;
  319. }
  320. void get_arc_info(void)
  321. {
  322. if (!init_fwenv())
  323. do_get_arc_info();
  324. }
  325. static int do_arc_cmd(struct cmd_tbl *cmdtp, int flag, int argc,
  326. char *const argv[])
  327. {
  328. const char *cmd;
  329. int ret = -1;
  330. cmd = argv[1];
  331. --argc;
  332. ++argv;
  333. if (init_fwenv())
  334. return ret;
  335. if (strcmp(cmd, "product") == 0)
  336. ret = set_arc_product(argc, argv);
  337. else if (strcmp(cmd, "info") == 0)
  338. ret = do_get_arc_info();
  339. if (ret == -1)
  340. return CMD_RET_USAGE;
  341. return ret;
  342. }
  343. U_BOOT_CMD(arc, 6, 1, do_arc_cmd,
  344. "Arcturus product command sub-system",
  345. "product serial hwaddr0 hwaddr1 hwaddr2 - save Arcturus factory env\n"
  346. "info - show Arcturus factory env\n\n");