board/Synology/ds414/cmd_syno.c

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