[people/ms/u-boot.git] / board / gateworks / gw_ventana / eeprom.c

/*
 * Copyright (C) 2014 Gateworks Corporation
 * Author: Tim Harvey <tharvey@gateworks.com>
 *
 * SPDX-License-Identifier: GPL-2.0+
 */

#include <common.h>
#include <errno.h>
#include <i2c.h>
#include <malloc.h>
#include <asm/bitops.h>

#include "gsc.h"
#include "ventana_eeprom.h"

/* read ventana EEPROM, check for validity, and return baseboard type */
int
read_eeprom(int bus, struct ventana_board_info *info)
{
	int i;
	int chksum;
	char baseboard;
	int type;
	unsigned char *buf = (unsigned char *)info;

	memset(info, 0, sizeof(*info));

	/*
	 * On a board with a missing/depleted backup battery for GSC, the
	 * board may be ready to probe the GSC before its firmware is
	 * running.  We will wait here indefinately for the GSC/EEPROM.
	 */
	while (1) {
		if (0 == i2c_set_bus_num(bus) &&
		    0 == i2c_probe(GSC_EEPROM_ADDR))
			break;
		mdelay(1);
	}

	/* read eeprom config section */
	if (gsc_i2c_read(GSC_EEPROM_ADDR, 0x00, 1, buf, sizeof(*info))) {
		puts("EEPROM: Failed to read EEPROM\n");
		return GW_UNKNOWN;
	}

	/* sanity checks */
	if (info->model[0] != 'G' || info->model[1] != 'W') {
		puts("EEPROM: Invalid Model in EEPROM\n");
		return GW_UNKNOWN;
	}

	/* validate checksum */
	for (chksum = 0, i = 0; i < sizeof(*info)-2; i++)
		chksum += buf[i];
	if ((info->chksum[0] != chksum>>8) ||
	    (info->chksum[1] != (chksum&0xff))) {
		puts("EEPROM: Failed EEPROM checksum\n");
		return GW_UNKNOWN;
	}

	/* original GW5400-A prototype */
	baseboard = info->model[3];
	if (strncasecmp((const char *)info->model, "GW5400-A", 8) == 0)
		baseboard = '0';

	switch (baseboard) {
	case '0': /* original GW5400-A prototype */
		type = GW54proto;
		break;
	case '1':
		type = GW51xx;
		break;
	case '2':
		type = GW52xx;
		break;
	case '3':
		type = GW53xx;
		break;
	case '4':
		type = GW54xx;
		break;
	case '5':
		if (info->model[4] == '1') {
			type = GW551x;
			break;
		} else if (info->model[4] == '2') {
			type = GW552x;
			break;
		}
		/* fall through */
	default:
		printf("EEPROM: Unknown model in EEPROM: %s\n", info->model);
		type = GW_UNKNOWN;
		break;
	}
	return type;
}

/* list of config bits that the bootloader will remove from dtb if not set */
struct ventana_eeprom_config econfig[] = {
	{ "eth0", "ethernet0", EECONFIG_ETH0 },
	{ "eth1", "ethernet1", EECONFIG_ETH1 },
	{ "sata", "ahci0", EECONFIG_SATA },
	{ "pcie", NULL, EECONFIG_PCIE},
	{ "lvds0", NULL, EECONFIG_LVDS0 },
	{ "lvds1", NULL, EECONFIG_LVDS1 },
	{ "usb0", NULL, EECONFIG_USB0 },
	{ "usb1", NULL, EECONFIG_USB1 },
	{ "mmc0", NULL, EECONFIG_SD0 },
	{ "mmc1", NULL, EECONFIG_SD1 },
	{ "mmc2", NULL, EECONFIG_SD2 },
	{ "mmc3", NULL, EECONFIG_SD3 },
	{ "uart0", NULL, EECONFIG_UART0 },
	{ "uart1", NULL, EECONFIG_UART1 },
	{ "uart2", NULL, EECONFIG_UART2 },
	{ "uart3", NULL, EECONFIG_UART3 },
	{ "uart4", NULL, EECONFIG_UART4 },
	{ "ipu0", NULL, EECONFIG_IPU0 },
	{ "ipu1", NULL, EECONFIG_IPU1 },
	{ "can0", NULL, EECONFIG_FLEXCAN },
	{ "i2c0", NULL, EECONFIG_I2C0 },
	{ "i2c1", NULL, EECONFIG_I2C1 },
	{ "i2c2", NULL, EECONFIG_I2C2 },
	{ "vpu", NULL, EECONFIG_VPU },
	{ "csi0", NULL, EECONFIG_CSI0 },
	{ "csi1", NULL, EECONFIG_CSI1 },
	{ "spi0", NULL, EECONFIG_ESPCI0 },
	{ "spi1", NULL, EECONFIG_ESPCI1 },
	{ "spi2", NULL, EECONFIG_ESPCI2 },
	{ "spi3", NULL, EECONFIG_ESPCI3 },
	{ "spi4", NULL, EECONFIG_ESPCI4 },
	{ "spi5", NULL, EECONFIG_ESPCI5 },
	{ "gps", "pps", EECONFIG_GPS },
	{ "hdmi_in", NULL, EECONFIG_HDMI_IN },
	{ "hdmi_out", NULL, EECONFIG_HDMI_OUT },
	{ "cvbs_in", NULL, EECONFIG_VID_IN },
	{ "cvbs_out", NULL, EECONFIG_VID_OUT },
	{ "nand", NULL, EECONFIG_NAND },
	{ /* Sentinel */ }
};

#ifdef CONFIG_CMD_EECONFIG
static struct ventana_eeprom_config *get_config(const char *name)
{
	struct ventana_eeprom_config *cfg = econfig;

	while (cfg->name) {
		if (0 == strcmp(name, cfg->name))
			return cfg;
		cfg++;
	}
	return NULL;
}

static u8 econfig_bytes[sizeof(ventana_info.config)];
static int econfig_init = -1;

int do_econfig(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
{
	struct ventana_eeprom_config *cfg;
	struct ventana_board_info *info = &ventana_info;
	int i;

	if (argc < 2)
		return CMD_RET_USAGE;

	/* initialize */
	if (econfig_init != 1) {
		memcpy(econfig_bytes, info->config, sizeof(econfig_bytes));
		econfig_init = 1;
	}

	/* list configs */
	if ((strncmp(argv[1], "list", 4) == 0)) {
		cfg = econfig;
		while (cfg->name) {
			printf("%s: %d\n", cfg->name,
			       test_bit(cfg->bit, econfig_bytes) ?  1 : 0);
			cfg++;
		}
	}

	/* save */
	else if ((strncmp(argv[1], "save", 4) == 0)) {
		unsigned char *buf = (unsigned char *)info;
		int chksum;

		/* calculate new checksum */
		memcpy(info->config, econfig_bytes, sizeof(econfig_bytes));
		for (chksum = 0, i = 0; i < sizeof(*info)-2; i++)
			chksum += buf[i];
		debug("old chksum:0x%04x\n",
		      (info->chksum[0] << 8) | info->chksum[1]);
		debug("new chksum:0x%04x\n", chksum);
		info->chksum[0] = chksum >> 8;
		info->chksum[1] = chksum & 0xff;

		/* write new config data */
		if (gsc_i2c_write(GSC_EEPROM_ADDR, info->config - (u8 *)info,
				  1, econfig_bytes, sizeof(econfig_bytes))) {
			printf("EEPROM: Failed updating config\n");
			return CMD_RET_FAILURE;
		}

		/* write new config data */
		if (gsc_i2c_write(GSC_EEPROM_ADDR, info->chksum - (u8 *)info,
				  1, info->chksum, 2)) {
			printf("EEPROM: Failed updating checksum\n");
			return CMD_RET_FAILURE;
		}

		printf("Config saved to EEPROM\n");
	}

	/* get config */
	else if (argc == 2) {
		cfg = get_config(argv[1]);
		if (cfg) {
			printf("%s: %d\n", cfg->name,
			       test_bit(cfg->bit, econfig_bytes) ? 1 : 0);
		} else {
			printf("invalid config: %s\n", argv[1]);
			return CMD_RET_FAILURE;
		}
	}

	/* set config */
	else if (argc == 3) {
		cfg = get_config(argv[1]);
		if (cfg) {
			if (simple_strtol(argv[2], NULL, 10)) {
				test_and_set_bit(cfg->bit, econfig_bytes);
				printf("Enabled %s\n", cfg->name);
			} else {
				test_and_clear_bit(cfg->bit, econfig_bytes);
				printf("Disabled %s\n", cfg->name);
			}
		} else {
			printf("invalid config: %s\n", argv[1]);
			return CMD_RET_FAILURE;
		}
	}

	else
		return CMD_RET_USAGE;

	return CMD_RET_SUCCESS;
}

U_BOOT_CMD(
	econfig, 3, 0, do_econfig,
	"EEPROM configuration",
	"list - list config\n"
	"save - save config to EEPROM\n"
	"<name> - get config 'name'\n"
	"<name> [0|1] - set config 'name' to value\n"
);

#endif /* CONFIG_CMD_EECONFIG */
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>
9c0fe83e TH	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 */