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 <hexdump.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 print_hex_dump_bytes("", DUMP_PREFIX_OFFSET, buf, 51 sizeof(*info)); 52 return GW_UNKNOWN; 53 } 54 55 /* validate checksum */ 56 for (chksum = 0, i = 0; i < sizeof(*info)-2; i++) 57 chksum += buf[i]; 58 if ((info->chksum[0] != chksum>>8) || 59 (info->chksum[1] != (chksum&0xff))) { 60 puts("EEPROM: Failed EEPROM checksum\n"); 61 print_hex_dump_bytes("", DUMP_PREFIX_OFFSET, buf, 62 sizeof(*info)); 63 return GW_UNKNOWN; 64 } 65 66 /* original GW5400-A prototype */ 67 baseboard = info->model[3]; 68 if (strncasecmp((const char *)info->model, "GW5400-A", 8) == 0) 69 baseboard = '0'; 70 71 type = GW_UNKNOWN; 72 switch (baseboard) { 73 case '0': /* original GW5400-A prototype */ 74 type = GW54proto; 75 break; 76 case '1': 77 type = GW51xx; 78 break; 79 case '2': 80 type = GW52xx; 81 break; 82 case '3': 83 type = GW53xx; 84 break; 85 case '4': 86 type = GW54xx; 87 break; 88 case '5': 89 if (info->model[4] == '1') { 90 type = GW551x; 91 break; 92 } else if (info->model[4] == '2') { 93 type = GW552x; 94 break; 95 } else if (info->model[4] == '3') { 96 type = GW553x; 97 break; 98 } 99 break; 100 case '6': 101 if (info->model[4] == '0') 102 type = GW560x; 103 break; 104 case '9': 105 if (info->model[4] == '0' && info->model[5] == '1') 106 type = GW5901; 107 else if (info->model[4] == '0' && info->model[5] == '2') 108 type = GW5902; 109 else if (info->model[4] == '0' && info->model[5] == '3') 110 type = GW5903; 111 else if (info->model[4] == '0' && info->model[5] == '4') 112 type = GW5904; 113 else if (info->model[4] == '0' && info->model[5] == '5') 114 type = GW5905; 115 else if (info->model[4] == '0' && info->model[5] == '6') 116 type = GW5906; 117 else if (info->model[4] == '0' && info->model[5] == '7') 118 type = GW5907; 119 else if (info->model[4] == '0' && info->model[5] == '8') 120 type = GW5908; 121 else if (info->model[4] == '0' && info->model[5] == '9') 122 type = GW5909; 123 break; 124 default: 125 printf("EEPROM: Unknown model in EEPROM: %s\n", info->model); 126 print_hex_dump_bytes("", DUMP_PREFIX_OFFSET, buf, 127 sizeof(*info)); 128 break; 129 } 130 return type; 131 } 132 133 /* list of config bits that the bootloader will remove from dtb if not set */ 134 struct ventana_eeprom_config econfig[] = { 135 { "eth0", "ethernet0", EECONFIG_ETH0 }, 136 { "usb0", NULL, EECONFIG_USB0 }, 137 { "usb1", NULL, EECONFIG_USB1 }, 138 { "mmc0", NULL, EECONFIG_SD0 }, 139 { "mmc1", NULL, EECONFIG_SD1 }, 140 { "mmc2", NULL, EECONFIG_SD2 }, 141 { "mmc3", NULL, EECONFIG_SD3 }, 142 { /* Sentinel */ } 143 }; 144 145 #if defined(CONFIG_CMD_EECONFIG) && !defined(CONFIG_SPL_BUILD) 146 static struct ventana_eeprom_config *get_config(const char *name) 147 { 148 struct ventana_eeprom_config *cfg = econfig; 149 150 while (cfg->name) { 151 if (0 == strcmp(name, cfg->name)) 152 return cfg; 153 cfg++; 154 } 155 return NULL; 156 } 157 158 static u8 econfig_bytes[sizeof(ventana_info.config)]; 159 static int econfig_init = -1; 160 161 static int do_econfig(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[]) 162 { 163 struct ventana_eeprom_config *cfg; 164 struct ventana_board_info *info = &ventana_info; 165 int i; 166 167 if (argc < 2) 168 return CMD_RET_USAGE; 169 170 /* initialize */ 171 if (econfig_init != 1) { 172 memcpy(econfig_bytes, info->config, sizeof(econfig_bytes)); 173 econfig_init = 1; 174 } 175 176 /* list configs */ 177 if ((strncmp(argv[1], "list", 4) == 0)) { 178 cfg = econfig; 179 while (cfg->name) { 180 printf("%s: %d\n", cfg->name, 181 test_bit(cfg->bit, econfig_bytes) ? 1 : 0); 182 cfg++; 183 } 184 } 185 186 /* save */ 187 else if ((strncmp(argv[1], "save", 4) == 0)) { 188 unsigned char *buf = (unsigned char *)info; 189 int chksum; 190 191 /* calculate new checksum */ 192 memcpy(info->config, econfig_bytes, sizeof(econfig_bytes)); 193 for (chksum = 0, i = 0; i < sizeof(*info)-2; i++) 194 chksum += buf[i]; 195 debug("old chksum:0x%04x\n", 196 (info->chksum[0] << 8) | info->chksum[1]); 197 debug("new chksum:0x%04x\n", chksum); 198 info->chksum[0] = chksum >> 8; 199 info->chksum[1] = chksum & 0xff; 200 201 /* write new config data */ 202 if (gsc_i2c_write(GSC_EEPROM_ADDR, info->config - (u8 *)info, 203 1, econfig_bytes, sizeof(econfig_bytes))) { 204 printf("EEPROM: Failed updating config\n"); 205 return CMD_RET_FAILURE; 206 } 207 208 /* write new config data */ 209 if (gsc_i2c_write(GSC_EEPROM_ADDR, info->chksum - (u8 *)info, 210 1, info->chksum, 2)) { 211 printf("EEPROM: Failed updating checksum\n"); 212 return CMD_RET_FAILURE; 213 } 214 215 printf("Config saved to EEPROM\n"); 216 } 217 218 /* get config */ 219 else if (argc == 2) { 220 cfg = get_config(argv[1]); 221 if (cfg) { 222 printf("%s: %d\n", cfg->name, 223 test_bit(cfg->bit, econfig_bytes) ? 1 : 0); 224 } else { 225 printf("invalid config: %s\n", argv[1]); 226 return CMD_RET_FAILURE; 227 } 228 } 229 230 /* set config */ 231 else if (argc == 3) { 232 cfg = get_config(argv[1]); 233 if (cfg) { 234 if (simple_strtol(argv[2], NULL, 10)) { 235 test_and_set_bit(cfg->bit, econfig_bytes); 236 printf("Enabled %s\n", cfg->name); 237 } else { 238 test_and_clear_bit(cfg->bit, econfig_bytes); 239 printf("Disabled %s\n", cfg->name); 240 } 241 } else { 242 printf("invalid config: %s\n", argv[1]); 243 return CMD_RET_FAILURE; 244 } 245 } 246 247 else 248 return CMD_RET_USAGE; 249 250 return CMD_RET_SUCCESS; 251 } 252 253 U_BOOT_CMD( 254 econfig, 3, 0, do_econfig, 255 "EEPROM configuration", 256 "list - list config\n" 257 "save - save config to EEPROM\n" 258 "<name> - get config 'name'\n" 259 "<name> [0|1] - set config 'name' to value\n" 260 ); 261 262 #endif /* CONFIG_CMD_EECONFIG */ 263