cmd_syno.c 5.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * Commands to deal with Synology specifics.
  4. *
  5. * Copyright (C) 2015 Phil Sutter <phil@nwl.cc>
  6. */
  7. #include <common.h>
  8. #include <command.h>
  9. #include <div64.h>
  10. #include <env.h>
  11. #include <net.h>
  12. #include <spi.h>
  13. #include <spi_flash.h>
  14. #include <linux/mtd/mtd.h>
  15. #include <asm/io.h>
  16. #include "../drivers/ddr/marvell/axp/ddr3_init.h"
  17. #define ETHADDR_MAX 4
  18. #define SYNO_SN_TAG "SN="
  19. #define SYNO_CHKSUM_TAG "CHK="
  20. static int do_syno_populate(int argc, char *const argv[])
  21. {
  22. unsigned int bus = CONFIG_SF_DEFAULT_BUS;
  23. unsigned int cs = CONFIG_SF_DEFAULT_CS;
  24. unsigned int speed = CONFIG_SF_DEFAULT_SPEED;
  25. unsigned int mode = CONFIG_SF_DEFAULT_MODE;
  26. struct spi_flash *flash;
  27. unsigned long addr = 0x80000; /* XXX: parameterize this? */
  28. loff_t offset = 0x007d0000;
  29. loff_t len = 0x00010000;
  30. char *buf, *bufp;
  31. char var[128];
  32. char val[128];
  33. int ret, n;
  34. /* XXX: arg parsing to select flash here? */
  35. flash = spi_flash_probe(bus, cs, speed, mode);
  36. if (!flash) {
  37. printf("Failed to initialize SPI flash at %u:%u\n", bus, cs);
  38. return 1;
  39. }
  40. buf = map_physmem(addr, len, MAP_WRBACK);
  41. if (!buf) {
  42. puts("Failed to map physical memory\n");
  43. return 1;
  44. }
  45. ret = spi_flash_read(flash, offset, len, buf);
  46. if (ret) {
  47. puts("Failed to read from SPI flash\n");
  48. goto out_unmap;
  49. }
  50. for (n = 0; n < ETHADDR_MAX; n++) {
  51. char ethaddr[ETH_ALEN];
  52. int i, sum = 0;
  53. unsigned char csum = 0;
  54. for (i = 0, bufp = buf + n * 7; i < ETH_ALEN; i++) {
  55. sum += bufp[i];
  56. csum += bufp[i];
  57. ethaddr[i] = bufp[i];
  58. }
  59. if (!sum) /* MAC address empty */
  60. continue;
  61. if (csum != bufp[i]) { /* seventh byte is checksum value */
  62. printf("Invalid MAC address for interface %d!\n", n);
  63. continue;
  64. }
  65. if (n == 0)
  66. sprintf(var, "ethaddr");
  67. else
  68. sprintf(var, "eth%daddr", n);
  69. snprintf(val, sizeof(val) - 1,
  70. "%02x:%02x:%02x:%02x:%02x:%02x",
  71. ethaddr[0], ethaddr[1], ethaddr[2],
  72. ethaddr[3], ethaddr[4], ethaddr[5]);
  73. printf("parsed %s = %s\n", var, val);
  74. env_set(var, val);
  75. }
  76. if (!strncmp(buf + 32, SYNO_SN_TAG, strlen(SYNO_SN_TAG))) {
  77. char *snp, *csump;
  78. int csum = 0;
  79. unsigned long c;
  80. snp = bufp = buf + 32 + strlen(SYNO_SN_TAG);
  81. for (n = 0; bufp[n] && bufp[n] != ','; n++)
  82. csum += bufp[n];
  83. bufp[n] = '\0';
  84. /* should come right after, but you never know */
  85. bufp = strstr(bufp + n + 1, SYNO_CHKSUM_TAG);
  86. if (!bufp) {
  87. printf("Serial number checksum tag missing!\n");
  88. goto out_unmap;
  89. }
  90. csump = bufp += strlen(SYNO_CHKSUM_TAG);
  91. for (n = 0; bufp[n] && bufp[n] != ','; n++)
  92. ;
  93. bufp[n] = '\0';
  94. if (strict_strtoul(csump, 10, &c) || c != csum) {
  95. puts("Invalid serial number found!\n");
  96. ret = 1;
  97. goto out_unmap;
  98. }
  99. printf("parsed SN = %s\n", snp);
  100. env_set("SN", snp);
  101. } else { /* old style format */
  102. unsigned char csum = 0;
  103. for (n = 0, bufp = buf + 32; n < 10; n++)
  104. csum += bufp[n];
  105. if (csum != bufp[n]) {
  106. puts("Invalid serial number found!\n");
  107. ret = 1;
  108. goto out_unmap;
  109. }
  110. bufp[n] = '\0';
  111. printf("parsed SN = %s\n", buf + 32);
  112. env_set("SN", buf + 32);
  113. }
  114. out_unmap:
  115. unmap_physmem(buf, len);
  116. return ret;
  117. }
  118. /* map bit position to function in POWER_MNG_CTRL_REG */
  119. static const char * const pwr_mng_bit_func[] = {
  120. "audio",
  121. "ge3", "ge2", "ge1", "ge0",
  122. "pcie00", "pcie01", "pcie02", "pcie03",
  123. "pcie10", "pcie11", "pcie12", "pcie13",
  124. "bp",
  125. "sata0_link", "sata0_core",
  126. "lcd",
  127. "sdio",
  128. "usb0", "usb1", "usb2",
  129. "idma", "xor0", "crypto",
  130. NULL,
  131. "tdm",
  132. "pcie20", "pcie30",
  133. "xor1",
  134. "sata1_link", "sata1_core",
  135. NULL,
  136. };
  137. static int do_syno_clk_gate(int argc, char *const argv[])
  138. {
  139. u32 pwr_mng_ctrl_reg = reg_read(POWER_MNG_CTRL_REG);
  140. const char *func, *state;
  141. int i, val;
  142. if (argc < 2)
  143. return -1;
  144. if (!strcmp(argv[1], "get")) {
  145. puts("Clock Gating:\n");
  146. for (i = 0; i < 32; i++) {
  147. func = pwr_mng_bit_func[i];
  148. if (!func)
  149. continue;
  150. state = pwr_mng_ctrl_reg & (1 << i) ? "ON" : "OFF";
  151. printf("%s:\t\t%s\n", func, state);
  152. }
  153. return 0;
  154. }
  155. if (argc < 4)
  156. return -1;
  157. if (!strcmp(argv[1], "set")) {
  158. func = argv[2];
  159. state = argv[3];
  160. for (i = 0; i < 32; i++) {
  161. if (!pwr_mng_bit_func[i])
  162. continue;
  163. if (!strcmp(func, pwr_mng_bit_func[i]))
  164. break;
  165. }
  166. if (i == 32) {
  167. printf("Error: name '%s' not known\n", func);
  168. return -1;
  169. }
  170. val = state[0] != '0';
  171. pwr_mng_ctrl_reg |= (val << i);
  172. pwr_mng_ctrl_reg &= ~(!val << i);
  173. reg_write(POWER_MNG_CTRL_REG, pwr_mng_ctrl_reg);
  174. }
  175. return 0;
  176. }
  177. static int do_syno(struct cmd_tbl *cmdtp, int flag, int argc,
  178. char *const argv[])
  179. {
  180. const char *cmd;
  181. int ret = 0;
  182. if (argc < 2)
  183. goto usage;
  184. cmd = argv[1];
  185. --argc;
  186. ++argv;
  187. if (!strcmp(cmd, "populate_env"))
  188. ret = do_syno_populate(argc, argv);
  189. else if (!strcmp(cmd, "clk_gate"))
  190. ret = do_syno_clk_gate(argc, argv);
  191. if (ret != -1)
  192. return ret;
  193. usage:
  194. return CMD_RET_USAGE;
  195. }
  196. U_BOOT_CMD(
  197. syno, 5, 1, do_syno,
  198. "Synology specific commands",
  199. "populate_env - Read vendor data from SPI flash into environment\n"
  200. "clk_gate (get|set name 1|0) - Manage clock gating\n"
  201. );