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