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 <div64.h> 10 #include <spi.h> 11 #include <spi_flash.h> 12 #include <linux/mtd/mtd.h> 13 14 #include <asm/io.h> 15 #include "../drivers/ddr/marvell/axp/ddr3_init.h" 16 17 #define ETHADDR_MAX 4 18 #define SYNO_SN_TAG "SN=" 19 #define SYNO_CHKSUM_TAG "CHK=" 20 21 22 static 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 < 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 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 196 static int do_syno(cmd_tbl_t *cmdtp, int flag, 197 int argc, 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