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