1
2
3
4
5
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
18int
19read_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
31
32
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
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
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
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
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':
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 }
91
92 default:
93 printf("EEPROM: Unknown model in EEPROM: %s\n", info->model);
94 type = GW_UNKNOWN;
95 break;
96 }
97 return type;
98}
99
100
101struct 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 { }
141};
142
143#ifdef CONFIG_CMD_EECONFIG
144static 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
156static u8 econfig_bytes[sizeof(ventana_info.config)];
157static int econfig_init = -1;
158
159int 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
169 if (econfig_init != 1) {
170 memcpy(econfig_bytes, info->config, sizeof(econfig_bytes));
171 econfig_init = 1;
172 }
173
174
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
185 else if ((strncmp(argv[1], "save", 4) == 0)) {
186 unsigned char *buf = (unsigned char *)info;
187 int chksum;
188
189
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
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
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
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
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
251U_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
261