From: Tom Rini Date: Wed, 16 Mar 2016 19:25:46 +0000 (-0400) Subject: mvebu: ds414: Move cmd_syno into ds414 directory X-Git-Tag: v2016.05-rc1~335 X-Git-Url: https://git.librecmc.org/?a=commitdiff_plain;h=d08fedf691dcf4137df406110b7c6f6007f42ee3;p=oweals%2Fu-boot.git mvebu: ds414: Move cmd_syno into ds414 directory When we switch to including all linker lists in SPL it is important to not include commands as that may lead to link errors due to other things we have already discarded. In this case as we don't have other common code nor other Synology borads, move the cmd_syno.c file (which claims to be ds414 specific anyways!) into the ds414 directory and only build it for non-SPL builds. Signed-off-by: Tom Rini --- diff --git a/board/Synology/common/Makefile b/board/Synology/common/Makefile deleted file mode 100644 index e66aeb8467..0000000000 --- a/board/Synology/common/Makefile +++ /dev/null @@ -1,7 +0,0 @@ -# -# Copyright (C) 2015 Phil Sutter -# -# SPDX-License-Identifier: GPL-2.0+ -# - -obj-y := cmd_syno.o diff --git a/board/Synology/common/cmd_syno.c b/board/Synology/common/cmd_syno.c deleted file mode 100644 index 20544e29c4..0000000000 --- a/board/Synology/common/cmd_syno.c +++ /dev/null @@ -1,227 +0,0 @@ -/* - * Commands to deal with Synology specifics. - * - * Copyright (C) 2015 Phil Sutter - * - * SPDX-License-Identifier: GPL-2.0+ - */ - -#include -#include -#include -#include -#include - -#include -#include "../drivers/ddr/marvell/axp/ddr3_init.h" - -#define ETH_ALEN 6 -#define ETHADDR_MAX 4 -#define SYNO_SN_TAG "SN=" -#define SYNO_CHKSUM_TAG "CHK=" - - -static int do_syno_populate(int argc, char * const argv[]) -{ - unsigned int bus = CONFIG_SF_DEFAULT_BUS; - unsigned int cs = CONFIG_SF_DEFAULT_CS; - unsigned int speed = CONFIG_SF_DEFAULT_SPEED; - unsigned int mode = CONFIG_SF_DEFAULT_MODE; - struct spi_flash *flash; - unsigned long addr = 0x80000; /* XXX: parameterize this? */ - loff_t offset = 0x007d0000; - loff_t len = 0x00010000; - char *buf, *bufp; - char var[128]; - char val[128]; - int ret, n; - - /* XXX: arg parsing to select flash here? */ - - flash = spi_flash_probe(bus, cs, speed, mode); - if (!flash) { - printf("Failed to initialize SPI flash at %u:%u\n", bus, cs); - return 1; - } - - buf = map_physmem(addr, len, MAP_WRBACK); - if (!buf) { - puts("Failed to map physical memory\n"); - return 1; - } - - ret = spi_flash_read(flash, offset, len, buf); - if (ret) { - puts("Failed to read from SPI flash\n"); - goto out_unmap; - } - - for (n = 0; n < ETHADDR_MAX; n++) { - char ethaddr[ETH_ALEN]; - int i, sum = 0; - unsigned char csum = 0; - - for (i = 0, bufp = buf + n * 7; i < ETH_ALEN; i++) { - sum += bufp[i]; - csum += bufp[i]; - ethaddr[i] = bufp[i]; - } - if (!sum) /* MAC address empty */ - continue; - if (csum != bufp[i]) { /* seventh byte is checksum value */ - printf("Invalid MAC address for interface %d!\n", n); - continue; - } - if (n == 0) - sprintf(var, "ethaddr"); - else - sprintf(var, "eth%daddr", n); - snprintf(val, sizeof(val) - 1, - "%02x:%02x:%02x:%02x:%02x:%02x", - ethaddr[0], ethaddr[1], ethaddr[2], - ethaddr[3], ethaddr[4], ethaddr[5]); - printf("parsed %s = %s\n", var, val); - setenv(var, val); - } - if (!strncmp(buf + 32, SYNO_SN_TAG, strlen(SYNO_SN_TAG))) { - char *snp, *csump; - int csum = 0; - unsigned long c; - - snp = bufp = buf + 32 + strlen(SYNO_SN_TAG); - for (n = 0; bufp[n] && bufp[n] != ','; n++) - csum += bufp[n]; - bufp[n] = '\0'; - - /* should come right after, but you never know */ - bufp = strstr(bufp + n + 1, SYNO_CHKSUM_TAG); - if (!bufp) { - printf("Serial number checksum tag missing!\n"); - goto out_unmap; - } - - csump = bufp += strlen(SYNO_CHKSUM_TAG); - for (n = 0; bufp[n] && bufp[n] != ','; n++) - ; - bufp[n] = '\0'; - - if (strict_strtoul(csump, 10, &c) || c != csum) { - puts("Invalid serial number found!\n"); - ret = 1; - goto out_unmap; - } - printf("parsed SN = %s\n", snp); - setenv("SN", snp); - } else { /* old style format */ - unsigned char csum = 0; - - for (n = 0, bufp = buf + 32; n < 10; n++) - csum += bufp[n]; - - if (csum != bufp[n]) { - puts("Invalid serial number found!\n"); - ret = 1; - goto out_unmap; - } - bufp[n] = '\0'; - printf("parsed SN = %s\n", buf + 32); - setenv("SN", buf + 32); - } -out_unmap: - unmap_physmem(buf, len); - return ret; -} - -/* map bit position to function in POWER_MNG_CTRL_REG */ -static const char * const pwr_mng_bit_func[] = { - "audio", - "ge3", "ge2", "ge1", "ge0", - "pcie00", "pcie01", "pcie02", "pcie03", - "pcie10", "pcie11", "pcie12", "pcie13", - "bp", - "sata0_link", "sata0_core", - "lcd", - "sdio", - "usb0", "usb1", "usb2", - "idma", "xor0", "crypto", - NULL, - "tdm", - "pcie20", "pcie30", - "xor1", - "sata1_link", "sata1_core", - NULL, -}; - -static int do_syno_clk_gate(int argc, char * const argv[]) -{ - u32 pwr_mng_ctrl_reg = reg_read(POWER_MNG_CTRL_REG); - const char *func, *state; - int i, val; - - if (argc < 2) - return -1; - - if (!strcmp(argv[1], "get")) { - puts("Clock Gating:\n"); - for (i = 0; i < 32; i++) { - func = pwr_mng_bit_func[i]; - if (!func) - continue; - state = pwr_mng_ctrl_reg & (1 << i) ? "ON" : "OFF"; - printf("%s:\t\t%s\n", func, state); - } - return 0; - } - if (argc < 4) - return -1; - if (!strcmp(argv[1], "set")) { - func = argv[2]; - state = argv[3]; - for (i = 0; i < 32; i++) { - if (!pwr_mng_bit_func[i]) - continue; - if (!strcmp(func, pwr_mng_bit_func[i])) - break; - } - if (i == 32) { - printf("Error: name '%s' not known\n", func); - return -1; - } - val = state[0] != '0'; - pwr_mng_ctrl_reg |= (val << i); - pwr_mng_ctrl_reg &= ~(!val << i); - reg_write(POWER_MNG_CTRL_REG, pwr_mng_ctrl_reg); - } - return 0; -} - -static int do_syno(cmd_tbl_t *cmdtp, int flag, - int argc, char * const argv[]) -{ - const char *cmd; - int ret = 0; - - if (argc < 2) - goto usage; - - cmd = argv[1]; - --argc; - ++argv; - - if (!strcmp(cmd, "populate_env")) - ret = do_syno_populate(argc, argv); - else if (!strcmp(cmd, "clk_gate")) - ret = do_syno_clk_gate(argc, argv); - - if (ret != -1) - return ret; -usage: - return CMD_RET_USAGE; -} - -U_BOOT_CMD( - syno, 5, 1, do_syno, - "Synology specific commands", - "populate_env - Read vendor data from SPI flash into environment\n" - "clk_gate (get|set name 1|0) - Manage clock gating\n" -); diff --git a/board/Synology/ds414/Makefile b/board/Synology/ds414/Makefile index 0f4c32d57c..93be101575 100644 --- a/board/Synology/ds414/Makefile +++ b/board/Synology/ds414/Makefile @@ -4,4 +4,7 @@ # SPDX-License-Identifier: GPL-2.0+ # -obj-y := ds414.o +obj-y += ds414.o +ifndef CONFIG_SPL_BUILD +obj-y += cmd_syno.o +endif diff --git a/board/Synology/ds414/cmd_syno.c b/board/Synology/ds414/cmd_syno.c new file mode 100644 index 0000000000..20544e29c4 --- /dev/null +++ b/board/Synology/ds414/cmd_syno.c @@ -0,0 +1,227 @@ +/* + * Commands to deal with Synology specifics. + * + * Copyright (C) 2015 Phil Sutter + * + * SPDX-License-Identifier: GPL-2.0+ + */ + +#include +#include +#include +#include +#include + +#include +#include "../drivers/ddr/marvell/axp/ddr3_init.h" + +#define ETH_ALEN 6 +#define ETHADDR_MAX 4 +#define SYNO_SN_TAG "SN=" +#define SYNO_CHKSUM_TAG "CHK=" + + +static int do_syno_populate(int argc, char * const argv[]) +{ + unsigned int bus = CONFIG_SF_DEFAULT_BUS; + unsigned int cs = CONFIG_SF_DEFAULT_CS; + unsigned int speed = CONFIG_SF_DEFAULT_SPEED; + unsigned int mode = CONFIG_SF_DEFAULT_MODE; + struct spi_flash *flash; + unsigned long addr = 0x80000; /* XXX: parameterize this? */ + loff_t offset = 0x007d0000; + loff_t len = 0x00010000; + char *buf, *bufp; + char var[128]; + char val[128]; + int ret, n; + + /* XXX: arg parsing to select flash here? */ + + flash = spi_flash_probe(bus, cs, speed, mode); + if (!flash) { + printf("Failed to initialize SPI flash at %u:%u\n", bus, cs); + return 1; + } + + buf = map_physmem(addr, len, MAP_WRBACK); + if (!buf) { + puts("Failed to map physical memory\n"); + return 1; + } + + ret = spi_flash_read(flash, offset, len, buf); + if (ret) { + puts("Failed to read from SPI flash\n"); + goto out_unmap; + } + + for (n = 0; n < ETHADDR_MAX; n++) { + char ethaddr[ETH_ALEN]; + int i, sum = 0; + unsigned char csum = 0; + + for (i = 0, bufp = buf + n * 7; i < ETH_ALEN; i++) { + sum += bufp[i]; + csum += bufp[i]; + ethaddr[i] = bufp[i]; + } + if (!sum) /* MAC address empty */ + continue; + if (csum != bufp[i]) { /* seventh byte is checksum value */ + printf("Invalid MAC address for interface %d!\n", n); + continue; + } + if (n == 0) + sprintf(var, "ethaddr"); + else + sprintf(var, "eth%daddr", n); + snprintf(val, sizeof(val) - 1, + "%02x:%02x:%02x:%02x:%02x:%02x", + ethaddr[0], ethaddr[1], ethaddr[2], + ethaddr[3], ethaddr[4], ethaddr[5]); + printf("parsed %s = %s\n", var, val); + setenv(var, val); + } + if (!strncmp(buf + 32, SYNO_SN_TAG, strlen(SYNO_SN_TAG))) { + char *snp, *csump; + int csum = 0; + unsigned long c; + + snp = bufp = buf + 32 + strlen(SYNO_SN_TAG); + for (n = 0; bufp[n] && bufp[n] != ','; n++) + csum += bufp[n]; + bufp[n] = '\0'; + + /* should come right after, but you never know */ + bufp = strstr(bufp + n + 1, SYNO_CHKSUM_TAG); + if (!bufp) { + printf("Serial number checksum tag missing!\n"); + goto out_unmap; + } + + csump = bufp += strlen(SYNO_CHKSUM_TAG); + for (n = 0; bufp[n] && bufp[n] != ','; n++) + ; + bufp[n] = '\0'; + + if (strict_strtoul(csump, 10, &c) || c != csum) { + puts("Invalid serial number found!\n"); + ret = 1; + goto out_unmap; + } + printf("parsed SN = %s\n", snp); + setenv("SN", snp); + } else { /* old style format */ + unsigned char csum = 0; + + for (n = 0, bufp = buf + 32; n < 10; n++) + csum += bufp[n]; + + if (csum != bufp[n]) { + puts("Invalid serial number found!\n"); + ret = 1; + goto out_unmap; + } + bufp[n] = '\0'; + printf("parsed SN = %s\n", buf + 32); + setenv("SN", buf + 32); + } +out_unmap: + unmap_physmem(buf, len); + return ret; +} + +/* map bit position to function in POWER_MNG_CTRL_REG */ +static const char * const pwr_mng_bit_func[] = { + "audio", + "ge3", "ge2", "ge1", "ge0", + "pcie00", "pcie01", "pcie02", "pcie03", + "pcie10", "pcie11", "pcie12", "pcie13", + "bp", + "sata0_link", "sata0_core", + "lcd", + "sdio", + "usb0", "usb1", "usb2", + "idma", "xor0", "crypto", + NULL, + "tdm", + "pcie20", "pcie30", + "xor1", + "sata1_link", "sata1_core", + NULL, +}; + +static int do_syno_clk_gate(int argc, char * const argv[]) +{ + u32 pwr_mng_ctrl_reg = reg_read(POWER_MNG_CTRL_REG); + const char *func, *state; + int i, val; + + if (argc < 2) + return -1; + + if (!strcmp(argv[1], "get")) { + puts("Clock Gating:\n"); + for (i = 0; i < 32; i++) { + func = pwr_mng_bit_func[i]; + if (!func) + continue; + state = pwr_mng_ctrl_reg & (1 << i) ? "ON" : "OFF"; + printf("%s:\t\t%s\n", func, state); + } + return 0; + } + if (argc < 4) + return -1; + if (!strcmp(argv[1], "set")) { + func = argv[2]; + state = argv[3]; + for (i = 0; i < 32; i++) { + if (!pwr_mng_bit_func[i]) + continue; + if (!strcmp(func, pwr_mng_bit_func[i])) + break; + } + if (i == 32) { + printf("Error: name '%s' not known\n", func); + return -1; + } + val = state[0] != '0'; + pwr_mng_ctrl_reg |= (val << i); + pwr_mng_ctrl_reg &= ~(!val << i); + reg_write(POWER_MNG_CTRL_REG, pwr_mng_ctrl_reg); + } + return 0; +} + +static int do_syno(cmd_tbl_t *cmdtp, int flag, + int argc, char * const argv[]) +{ + const char *cmd; + int ret = 0; + + if (argc < 2) + goto usage; + + cmd = argv[1]; + --argc; + ++argv; + + if (!strcmp(cmd, "populate_env")) + ret = do_syno_populate(argc, argv); + else if (!strcmp(cmd, "clk_gate")) + ret = do_syno_clk_gate(argc, argv); + + if (ret != -1) + return ret; +usage: + return CMD_RET_USAGE; +} + +U_BOOT_CMD( + syno, 5, 1, do_syno, + "Synology specific commands", + "populate_env - Read vendor data from SPI flash into environment\n" + "clk_gate (get|set name 1|0) - Manage clock gating\n" +);