]>
Commit | Line | Data |
---|---|---|
1badf2f4 TH |
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> | |
9c0fe83e | 9 | #include <errno.h> |
1badf2f4 | 10 | #include <i2c.h> |
9c0fe83e TH |
11 | #include <malloc.h> |
12 | #include <asm/bitops.h> | |
1badf2f4 TH |
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"); | |
1badf2f4 TH |
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"); | |
1badf2f4 TH |
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"); | |
1badf2f4 TH |
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 | 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; | |
3aa22674 | 83 | case '5': |
75f21e31 TH |
84 | if (info->model[4] == '1') { |
85 | type = GW551x; | |
86 | break; | |
87 | } else if (info->model[4] == '2') { | |
88 | type = GW552x; | |
89 | break; | |
90 | } | |
91 | /* fall through */ | |
1badf2f4 TH |
92 | default: |
93 | printf("EEPROM: Unknown model in EEPROM: %s\n", info->model); | |
94 | type = GW_UNKNOWN; | |
95 | break; | |
96 | } | |
97 | return type; | |
98 | } | |
9c0fe83e TH |
99 | |
100 | /* list of config bits that the bootloader will remove from dtb if not set */ | |
101 | struct ventana_eeprom_config econfig[] = { | |
102 | { "eth0", "ethernet0", EECONFIG_ETH0 }, | |
103 | { "eth1", "ethernet1", EECONFIG_ETH1 }, | |
104 | { "sata", "ahci0", EECONFIG_SATA }, | |
105 | { "pcie", NULL, EECONFIG_PCIE}, | |
106 | { "lvds0", NULL, EECONFIG_LVDS0 }, | |
107 | { "lvds1", NULL, EECONFIG_LVDS1 }, | |
108 | { "usb0", NULL, EECONFIG_USB0 }, | |
109 | { "usb1", NULL, EECONFIG_USB1 }, | |
110 | { "mmc0", NULL, EECONFIG_SD0 }, | |
111 | { "mmc1", NULL, EECONFIG_SD1 }, | |
112 | { "mmc2", NULL, EECONFIG_SD2 }, | |
113 | { "mmc3", NULL, EECONFIG_SD3 }, | |
114 | { "uart0", NULL, EECONFIG_UART0 }, | |
115 | { "uart1", NULL, EECONFIG_UART1 }, | |
116 | { "uart2", NULL, EECONFIG_UART2 }, | |
117 | { "uart3", NULL, EECONFIG_UART3 }, | |
118 | { "uart4", NULL, EECONFIG_UART4 }, | |
119 | { "ipu0", NULL, EECONFIG_IPU0 }, | |
120 | { "ipu1", NULL, EECONFIG_IPU1 }, | |
121 | { "can0", NULL, EECONFIG_FLEXCAN }, | |
122 | { "i2c0", NULL, EECONFIG_I2C0 }, | |
123 | { "i2c1", NULL, EECONFIG_I2C1 }, | |
124 | { "i2c2", NULL, EECONFIG_I2C2 }, | |
125 | { "vpu", NULL, EECONFIG_VPU }, | |
126 | { "csi0", NULL, EECONFIG_CSI0 }, | |
127 | { "csi1", NULL, EECONFIG_CSI1 }, | |
128 | { "spi0", NULL, EECONFIG_ESPCI0 }, | |
129 | { "spi1", NULL, EECONFIG_ESPCI1 }, | |
130 | { "spi2", NULL, EECONFIG_ESPCI2 }, | |
131 | { "spi3", NULL, EECONFIG_ESPCI3 }, | |
132 | { "spi4", NULL, EECONFIG_ESPCI4 }, | |
133 | { "spi5", NULL, EECONFIG_ESPCI5 }, | |
134 | { "gps", "pps", EECONFIG_GPS }, | |
135 | { "hdmi_in", NULL, EECONFIG_HDMI_IN }, | |
136 | { "hdmi_out", NULL, EECONFIG_HDMI_OUT }, | |
137 | { "cvbs_in", NULL, EECONFIG_VID_IN }, | |
138 | { "cvbs_out", NULL, EECONFIG_VID_OUT }, | |
139 | { "nand", NULL, EECONFIG_NAND }, | |
140 | { /* Sentinel */ } | |
141 | }; | |
142 | ||
143 | #ifdef CONFIG_CMD_EECONFIG | |
144 | static struct ventana_eeprom_config *get_config(const char *name) | |
145 | { | |
146 | struct ventana_eeprom_config *cfg = econfig; | |
147 | ||
148 | while (cfg->name) { | |
149 | if (0 == strcmp(name, cfg->name)) | |
150 | return cfg; | |
151 | cfg++; | |
152 | } | |
153 | return NULL; | |
154 | } | |
155 | ||
156 | static u8 econfig_bytes[sizeof(ventana_info.config)]; | |
157 | static int econfig_init = -1; | |
158 | ||
159 | int do_econfig(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[]) | |
160 | { | |
161 | struct ventana_eeprom_config *cfg; | |
162 | struct ventana_board_info *info = &ventana_info; | |
163 | int i; | |
164 | ||
165 | if (argc < 2) | |
166 | return CMD_RET_USAGE; | |
167 | ||
168 | /* initialize */ | |
169 | if (econfig_init != 1) { | |
170 | memcpy(econfig_bytes, info->config, sizeof(econfig_bytes)); | |
171 | econfig_init = 1; | |
172 | } | |
173 | ||
174 | /* list configs */ | |
175 | if ((strncmp(argv[1], "list", 4) == 0)) { | |
176 | cfg = econfig; | |
177 | while (cfg->name) { | |
178 | printf("%s: %d\n", cfg->name, | |
179 | test_bit(cfg->bit, econfig_bytes) ? 1 : 0); | |
180 | cfg++; | |
181 | } | |
182 | } | |
183 | ||
184 | /* save */ | |
185 | else if ((strncmp(argv[1], "save", 4) == 0)) { | |
186 | unsigned char *buf = (unsigned char *)info; | |
187 | int chksum; | |
188 | ||
189 | /* calculate new checksum */ | |
190 | memcpy(info->config, econfig_bytes, sizeof(econfig_bytes)); | |
191 | for (chksum = 0, i = 0; i < sizeof(*info)-2; i++) | |
192 | chksum += buf[i]; | |
193 | debug("old chksum:0x%04x\n", | |
194 | (info->chksum[0] << 8) | info->chksum[1]); | |
195 | debug("new chksum:0x%04x\n", chksum); | |
196 | info->chksum[0] = chksum >> 8; | |
197 | info->chksum[1] = chksum & 0xff; | |
198 | ||
199 | /* write new config data */ | |
200 | if (gsc_i2c_write(GSC_EEPROM_ADDR, info->config - (u8 *)info, | |
201 | 1, econfig_bytes, sizeof(econfig_bytes))) { | |
202 | printf("EEPROM: Failed updating config\n"); | |
203 | return CMD_RET_FAILURE; | |
204 | } | |
205 | ||
206 | /* write new config data */ | |
207 | if (gsc_i2c_write(GSC_EEPROM_ADDR, info->chksum - (u8 *)info, | |
208 | 1, info->chksum, 2)) { | |
209 | printf("EEPROM: Failed updating checksum\n"); | |
210 | return CMD_RET_FAILURE; | |
211 | } | |
212 | ||
213 | printf("Config saved to EEPROM\n"); | |
214 | } | |
215 | ||
216 | /* get config */ | |
217 | else if (argc == 2) { | |
218 | cfg = get_config(argv[1]); | |
219 | if (cfg) { | |
220 | printf("%s: %d\n", cfg->name, | |
221 | test_bit(cfg->bit, econfig_bytes) ? 1 : 0); | |
222 | } else { | |
223 | printf("invalid config: %s\n", argv[1]); | |
224 | return CMD_RET_FAILURE; | |
225 | } | |
226 | } | |
227 | ||
228 | /* set config */ | |
229 | else if (argc == 3) { | |
230 | cfg = get_config(argv[1]); | |
231 | if (cfg) { | |
232 | if (simple_strtol(argv[2], NULL, 10)) { | |
233 | test_and_set_bit(cfg->bit, econfig_bytes); | |
234 | printf("Enabled %s\n", cfg->name); | |
235 | } else { | |
236 | test_and_clear_bit(cfg->bit, econfig_bytes); | |
237 | printf("Disabled %s\n", cfg->name); | |
238 | } | |
239 | } else { | |
240 | printf("invalid config: %s\n", argv[1]); | |
241 | return CMD_RET_FAILURE; | |
242 | } | |
243 | } | |
244 | ||
245 | else | |
246 | return CMD_RET_USAGE; | |
247 | ||
248 | return CMD_RET_SUCCESS; | |
249 | } | |
250 | ||
251 | U_BOOT_CMD( | |
252 | econfig, 3, 0, do_econfig, | |
253 | "EEPROM configuration", | |
254 | "list - list config\n" | |
255 | "save - save config to EEPROM\n" | |
256 | "<name> - get config 'name'\n" | |
257 | "<name> [0|1] - set config 'name' to value\n" | |
258 | ); | |
259 | ||
260 | #endif /* CONFIG_CMD_EECONFIG */ |