123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266 |
- // SPDX-License-Identifier: GPL-2.0+
- /*
- * Copyright (C) 2014 Gateworks Corporation
- * Author: Tim Harvey <tharvey@gateworks.com>
- */
- #include <common.h>
- #include <command.h>
- #include <errno.h>
- #include <hexdump.h>
- #include <i2c.h>
- #include <log.h>
- #include <malloc.h>
- #include <asm/bitops.h>
- #include <linux/delay.h>
- #include "gsc.h"
- #include "ventana_eeprom.h"
- /* read ventana EEPROM, check for validity, and return baseboard type */
- int
- read_eeprom(int bus, struct ventana_board_info *info)
- {
- int i;
- int chksum;
- char baseboard;
- int type;
- unsigned char *buf = (unsigned char *)info;
- memset(info, 0, sizeof(*info));
- /*
- * On a board with a missing/depleted backup battery for GSC, the
- * board may be ready to probe the GSC before its firmware is
- * running. We will wait here indefinately for the GSC/EEPROM.
- */
- while (1) {
- if (0 == i2c_set_bus_num(bus) &&
- 0 == i2c_probe(GSC_EEPROM_ADDR))
- break;
- mdelay(1);
- }
- /* read eeprom config section */
- if (gsc_i2c_read(GSC_EEPROM_ADDR, 0x00, 1, buf, sizeof(*info))) {
- puts("EEPROM: Failed to read EEPROM\n");
- return GW_UNKNOWN;
- }
- /* sanity checks */
- if (info->model[0] != 'G' || info->model[1] != 'W') {
- puts("EEPROM: Invalid Model in EEPROM\n");
- print_hex_dump_bytes("", DUMP_PREFIX_OFFSET, buf,
- sizeof(*info));
- return GW_UNKNOWN;
- }
- /* validate checksum */
- for (chksum = 0, i = 0; i < sizeof(*info)-2; i++)
- chksum += buf[i];
- if ((info->chksum[0] != chksum>>8) ||
- (info->chksum[1] != (chksum&0xff))) {
- puts("EEPROM: Failed EEPROM checksum\n");
- print_hex_dump_bytes("", DUMP_PREFIX_OFFSET, buf,
- sizeof(*info));
- return GW_UNKNOWN;
- }
- /* original GW5400-A prototype */
- baseboard = info->model[3];
- if (strncasecmp((const char *)info->model, "GW5400-A", 8) == 0)
- baseboard = '0';
- type = GW_UNKNOWN;
- switch (baseboard) {
- case '0': /* original GW5400-A prototype */
- type = GW54proto;
- break;
- case '1':
- type = GW51xx;
- break;
- case '2':
- type = GW52xx;
- break;
- case '3':
- type = GW53xx;
- break;
- case '4':
- type = GW54xx;
- break;
- case '5':
- if (info->model[4] == '1') {
- type = GW551x;
- break;
- } else if (info->model[4] == '2') {
- type = GW552x;
- break;
- } else if (info->model[4] == '3') {
- type = GW553x;
- break;
- }
- break;
- case '6':
- if (info->model[4] == '0')
- type = GW560x;
- break;
- case '9':
- if (info->model[4] == '0' && info->model[5] == '1')
- type = GW5901;
- else if (info->model[4] == '0' && info->model[5] == '2')
- type = GW5902;
- else if (info->model[4] == '0' && info->model[5] == '3')
- type = GW5903;
- else if (info->model[4] == '0' && info->model[5] == '4')
- type = GW5904;
- else if (info->model[4] == '0' && info->model[5] == '5')
- type = GW5905;
- else if (info->model[4] == '0' && info->model[5] == '6')
- type = GW5906;
- else if (info->model[4] == '0' && info->model[5] == '7')
- type = GW5907;
- else if (info->model[4] == '0' && info->model[5] == '8')
- type = GW5908;
- else if (info->model[4] == '0' && info->model[5] == '9')
- type = GW5909;
- break;
- default:
- printf("EEPROM: Unknown model in EEPROM: %s\n", info->model);
- print_hex_dump_bytes("", DUMP_PREFIX_OFFSET, buf,
- sizeof(*info));
- break;
- }
- return type;
- }
- /* list of config bits that the bootloader will remove from dtb if not set */
- struct ventana_eeprom_config econfig[] = {
- { "eth0", "ethernet0", EECONFIG_ETH0 },
- { "usb0", NULL, EECONFIG_USB0 },
- { "usb1", NULL, EECONFIG_USB1 },
- { "mmc0", NULL, EECONFIG_SD0 },
- { "mmc1", NULL, EECONFIG_SD1 },
- { "mmc2", NULL, EECONFIG_SD2 },
- { "mmc3", NULL, EECONFIG_SD3 },
- { /* Sentinel */ }
- };
- #if defined(CONFIG_CMD_EECONFIG) && !defined(CONFIG_SPL_BUILD)
- static struct ventana_eeprom_config *get_config(const char *name)
- {
- struct ventana_eeprom_config *cfg = econfig;
- while (cfg->name) {
- if (0 == strcmp(name, cfg->name))
- return cfg;
- cfg++;
- }
- return NULL;
- }
- static u8 econfig_bytes[sizeof(ventana_info.config)];
- static int econfig_init = -1;
- static int do_econfig(struct cmd_tbl *cmdtp, int flag, int argc,
- char *const argv[])
- {
- struct ventana_eeprom_config *cfg;
- struct ventana_board_info *info = &ventana_info;
- int i;
- if (argc < 2)
- return CMD_RET_USAGE;
- /* initialize */
- if (econfig_init != 1) {
- memcpy(econfig_bytes, info->config, sizeof(econfig_bytes));
- econfig_init = 1;
- }
- /* list configs */
- if ((strncmp(argv[1], "list", 4) == 0)) {
- cfg = econfig;
- while (cfg->name) {
- printf("%s: %d\n", cfg->name,
- test_bit(cfg->bit, econfig_bytes) ? 1 : 0);
- cfg++;
- }
- }
- /* save */
- else if ((strncmp(argv[1], "save", 4) == 0)) {
- unsigned char *buf = (unsigned char *)info;
- int chksum;
- /* calculate new checksum */
- memcpy(info->config, econfig_bytes, sizeof(econfig_bytes));
- for (chksum = 0, i = 0; i < sizeof(*info)-2; i++)
- chksum += buf[i];
- debug("old chksum:0x%04x\n",
- (info->chksum[0] << 8) | info->chksum[1]);
- debug("new chksum:0x%04x\n", chksum);
- info->chksum[0] = chksum >> 8;
- info->chksum[1] = chksum & 0xff;
- /* write new config data */
- if (gsc_i2c_write(GSC_EEPROM_ADDR, info->config - (u8 *)info,
- 1, econfig_bytes, sizeof(econfig_bytes))) {
- printf("EEPROM: Failed updating config\n");
- return CMD_RET_FAILURE;
- }
- /* write new config data */
- if (gsc_i2c_write(GSC_EEPROM_ADDR, info->chksum - (u8 *)info,
- 1, info->chksum, 2)) {
- printf("EEPROM: Failed updating checksum\n");
- return CMD_RET_FAILURE;
- }
- printf("Config saved to EEPROM\n");
- }
- /* get config */
- else if (argc == 2) {
- cfg = get_config(argv[1]);
- if (cfg) {
- printf("%s: %d\n", cfg->name,
- test_bit(cfg->bit, econfig_bytes) ? 1 : 0);
- } else {
- printf("invalid config: %s\n", argv[1]);
- return CMD_RET_FAILURE;
- }
- }
- /* set config */
- else if (argc == 3) {
- cfg = get_config(argv[1]);
- if (cfg) {
- if (simple_strtol(argv[2], NULL, 10)) {
- test_and_set_bit(cfg->bit, econfig_bytes);
- printf("Enabled %s\n", cfg->name);
- } else {
- test_and_clear_bit(cfg->bit, econfig_bytes);
- printf("Disabled %s\n", cfg->name);
- }
- } else {
- printf("invalid config: %s\n", argv[1]);
- return CMD_RET_FAILURE;
- }
- }
- else
- return CMD_RET_USAGE;
- return CMD_RET_SUCCESS;
- }
- U_BOOT_CMD(
- econfig, 3, 0, do_econfig,
- "EEPROM configuration",
- "list - list config\n"
- "save - save config to EEPROM\n"
- "<name> - get config 'name'\n"
- "<name> [0|1] - set config 'name' to value\n"
- );
- #endif /* CONFIG_CMD_EECONFIG */
|