board/gateworks/gw_ventana/eeprom.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * Copyright (C) 2014 Gateworks Corporation
   4  * Author: Tim Harvey <tharvey@gateworks.com>
   5  */
   6
   7 #include <common.h>
   8 #include <errno.h>
   9 #include <i2c.h>
  10 #include <malloc.h>
  11 #include <asm/bitops.h>
  12
  13 #include "gsc.h"
  14 #include "ventana_eeprom.h"
  15
  16 /* read ventana EEPROM, check for validity, and return baseboard type */
  17 int
  18 read_eeprom(int bus, struct ventana_board_info *info)
  19 {
  20         int i;
  21         int chksum;
  22         char baseboard;
  23         int type;
  24         unsigned char *buf = (unsigned char *)info;
  25
  26         memset(info, 0, sizeof(*info));
  27
  28         /*
  29          * On a board with a missing/depleted backup battery for GSC, the
  30          * board may be ready to probe the GSC before its firmware is
  31          * running.  We will wait here indefinately for the GSC/EEPROM.
  32          */
  33         while (1) {
  34                 if (0 == i2c_set_bus_num(bus) &&
  35                     0 == i2c_probe(GSC_EEPROM_ADDR))
  36                         break;
  37                 mdelay(1);
  38         }
  39
  40         /* read eeprom config section */
  41         if (gsc_i2c_read(GSC_EEPROM_ADDR, 0x00, 1, buf, sizeof(*info))) {
  42                 puts("EEPROM: Failed to read EEPROM\n");
  43                 return GW_UNKNOWN;
  44         }
  45
  46         /* sanity checks */
  47         if (info->model[0] != 'G' || info->model[1] != 'W') {
  48                 puts("EEPROM: Invalid Model in EEPROM\n");
  49                 return GW_UNKNOWN;
  50         }
  51
  52         /* validate checksum */
  53         for (chksum = 0, i = 0; i < sizeof(*info)-2; i++)
  54                 chksum += buf[i];
  55         if ((info->chksum[0] != chksum>>8) ||
  56             (info->chksum[1] != (chksum&0xff))) {
  57                 puts("EEPROM: Failed EEPROM checksum\n");
  58                 return GW_UNKNOWN;
  59         }
  60
  61         /* original GW5400-A prototype */
  62         baseboard = info->model[3];
  63         if (strncasecmp((const char *)info->model, "GW5400-A", 8) == 0)
  64                 baseboard = '0';
  65
  66         type = GW_UNKNOWN;
  67         switch (baseboard) {
  68         case '0': /* original GW5400-A prototype */
  69                 type = GW54proto;
  70                 break;
  71         case '1':
  72                 type = GW51xx;
  73                 break;
  74         case '2':
  75                 type = GW52xx;
  76                 break;
  77         case '3':
  78                 type = GW53xx;
  79                 break;
  80         case '4':
  81                 type = GW54xx;
  82                 break;
  83         case '5':
  84                 if (info->model[4] == '1') {
  85                         type = GW551x;
  86                         break;
  87                 } else if (info->model[4] == '2') {
  88                         type = GW552x;
  89                         break;
  90                 } else if (info->model[4] == '3') {
  91                         type = GW553x;
  92                         break;
  93                 }
  94                 break;
  95         case '6':
  96                 if (info->model[4] == '0')
  97                         type = GW560x;
  98                 break;
  99         case '9':
 100                 if (info->model[4] == '0' && info->model[5] == '3')
 101                         type = GW5903;
 102                 else if (info->model[4] == '0' && info->model[5] == '4')
 103                         type = GW5904;
 104                 else if (info->model[4] == '0' && info->model[5] == '5')
 105                         type = GW5905;
 106                 else if (info->model[4] == '0' && info->model[5] == '6')
 107                         type = GW5906;
 108                 break;
 109         }
 110         return type;
 111 }
 112
 113 /* list of config bits that the bootloader will remove from dtb if not set */
 114 struct ventana_eeprom_config econfig[] = {
 115         { "eth0", "ethernet0", EECONFIG_ETH0 },
 116         { "usb0", NULL, EECONFIG_USB0 },
 117         { "usb1", NULL, EECONFIG_USB1 },
 118         { "mmc0", NULL, EECONFIG_SD0 },
 119         { "mmc1", NULL, EECONFIG_SD1 },
 120         { "mmc2", NULL, EECONFIG_SD2 },
 121         { "mmc3", NULL, EECONFIG_SD3 },
 122         { /* Sentinel */ }
 123 };
 124
 125 #if defined(CONFIG_CMD_EECONFIG) && !defined(CONFIG_SPL_BUILD)
 126 static struct ventana_eeprom_config *get_config(const char *name)
 127 {
 128         struct ventana_eeprom_config *cfg = econfig;
 129
 130         while (cfg->name) {
 131                 if (0 == strcmp(name, cfg->name))
 132                         return cfg;
 133                 cfg++;
 134         }
 135         return NULL;
 136 }
 137
 138 static u8 econfig_bytes[sizeof(ventana_info.config)];
 139 static int econfig_init = -1;
 140
 141 static int do_econfig(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
 142 {
 143         struct ventana_eeprom_config *cfg;
 144         struct ventana_board_info *info = &ventana_info;
 145         int i;
 146
 147         if (argc < 2)
 148                 return CMD_RET_USAGE;
 149
 150         /* initialize */
 151         if (econfig_init != 1) {
 152                 memcpy(econfig_bytes, info->config, sizeof(econfig_bytes));
 153                 econfig_init = 1;
 154         }
 155
 156         /* list configs */
 157         if ((strncmp(argv[1], "list", 4) == 0)) {
 158                 cfg = econfig;
 159                 while (cfg->name) {
 160                         printf("%s: %d\n", cfg->name,
 161                                test_bit(cfg->bit, econfig_bytes) ?  1 : 0);
 162                         cfg++;
 163                 }
 164         }
 165
 166         /* save */
 167         else if ((strncmp(argv[1], "save", 4) == 0)) {
 168                 unsigned char *buf = (unsigned char *)info;
 169                 int chksum;
 170
 171                 /* calculate new checksum */
 172                 memcpy(info->config, econfig_bytes, sizeof(econfig_bytes));
 173                 for (chksum = 0, i = 0; i < sizeof(*info)-2; i++)
 174                         chksum += buf[i];
 175                 debug("old chksum:0x%04x\n",
 176                       (info->chksum[0] << 8) | info->chksum[1]);
 177                 debug("new chksum:0x%04x\n", chksum);
 178                 info->chksum[0] = chksum >> 8;
 179                 info->chksum[1] = chksum & 0xff;
 180
 181                 /* write new config data */
 182                 if (gsc_i2c_write(GSC_EEPROM_ADDR, info->config - (u8 *)info,
 183                                   1, econfig_bytes, sizeof(econfig_bytes))) {
 184                         printf("EEPROM: Failed updating config\n");
 185                         return CMD_RET_FAILURE;
 186                 }
 187
 188                 /* write new config data */
 189                 if (gsc_i2c_write(GSC_EEPROM_ADDR, info->chksum - (u8 *)info,
 190                                   1, info->chksum, 2)) {
 191                         printf("EEPROM: Failed updating checksum\n");
 192                         return CMD_RET_FAILURE;
 193                 }
 194
 195                 printf("Config saved to EEPROM\n");
 196         }
 197
 198         /* get config */
 199         else if (argc == 2) {
 200                 cfg = get_config(argv[1]);
 201                 if (cfg) {
 202                         printf("%s: %d\n", cfg->name,
 203                                test_bit(cfg->bit, econfig_bytes) ? 1 : 0);
 204                 } else {
 205                         printf("invalid config: %s\n", argv[1]);
 206                         return CMD_RET_FAILURE;
 207                 }
 208         }
 209
 210         /* set config */
 211         else if (argc == 3) {
 212                 cfg = get_config(argv[1]);
 213                 if (cfg) {
 214                         if (simple_strtol(argv[2], NULL, 10)) {
 215                                 test_and_set_bit(cfg->bit, econfig_bytes);
 216                                 printf("Enabled %s\n", cfg->name);
 217                         } else {
 218                                 test_and_clear_bit(cfg->bit, econfig_bytes);
 219                                 printf("Disabled %s\n", cfg->name);
 220                         }
 221                 } else {
 222                         printf("invalid config: %s\n", argv[1]);
 223                         return CMD_RET_FAILURE;
 224                 }
 225         }
 226
 227         else
 228                 return CMD_RET_USAGE;
 229
 230         return CMD_RET_SUCCESS;
 231 }
 232
 233 U_BOOT_CMD(
 234         econfig, 3, 0, do_econfig,
 235         "EEPROM configuration",
 236         "list - list config\n"
 237         "save - save config to EEPROM\n"
 238         "<name> - get config 'name'\n"
 239         "<name> [0|1] - set config 'name' to value\n"
 240 );
 241
 242 #endif /* CONFIG_CMD_EECONFIG */