[thirdparty/u-boot.git] / board / toradex / common / tdx-common.c

/*
 * Copyright (c) 2016 Toradex, Inc.
 *
 * SPDX-License-Identifier:	GPL-2.0+
 */

#include <common.h>
#include <g_dnl.h>
#include <libfdt.h>

#include "tdx-cfg-block.h"
#include <asm/setup.h>
#include "tdx-common.h"

#ifdef CONFIG_TDX_CFG_BLOCK
static char tdx_serial_str[9];
static char tdx_board_rev_str[6];

#ifdef CONFIG_REVISION_TAG
u32 get_board_rev(void)
{
	/* Check validity */
	if (!tdx_hw_tag.ver_major)
		return 0;

	return ((tdx_hw_tag.ver_major & 0xff) << 8) |
		((tdx_hw_tag.ver_minor & 0xf) << 4) |
		((tdx_hw_tag.ver_assembly & 0xf) + 0xa);
}
#endif /* CONFIG_TDX_CFG_BLOCK */

#ifdef CONFIG_SERIAL_TAG
void get_board_serial(struct tag_serialnr *serialnr)
{
	int array[8];
	unsigned int serial = tdx_serial;
	int i;

	serialnr->low = 0;
	serialnr->high = 0;

	/* Check validity */
	if (serial) {
		/*
		 * Convert to Linux serial number format (hexadecimal coded
		 * decimal)
		 */
		i = 7;
		while (serial) {
			array[i--] = serial % 10;
			serial /= 10;
		}
		while (i >= 0)
			array[i--] = 0;
		serial = array[0];
		for (i = 1; i < 8; i++) {
			serial *= 16;
			serial += array[i];
		}

		serialnr->low = serial;
	}
}
#endif /* CONFIG_SERIAL_TAG */

int show_board_info(void)
{
	unsigned char ethaddr[6];

	if (read_tdx_cfg_block()) {
		printf("Missing Toradex config block\n");
		checkboard();
		return 0;
	}

	/* board serial-number */
	sprintf(tdx_serial_str, "%08u", tdx_serial);
	sprintf(tdx_board_rev_str, "V%1d.%1d%c",
		tdx_hw_tag.ver_major,
		tdx_hw_tag.ver_minor,
		(char)tdx_hw_tag.ver_assembly + 'A');

	env_set("serial#", tdx_serial_str);

	/*
	 * Check if environment contains a valid MAC address,
	 * set the one from config block if not
	 */
	if (!eth_env_get_enetaddr("ethaddr", ethaddr))
		eth_env_set_enetaddr("ethaddr", (u8 *)&tdx_eth_addr);

#ifdef CONFIG_TDX_CFG_BLOCK_2ND_ETHADDR
	if (!eth_env_get_enetaddr("eth1addr", ethaddr)) {
		/*
		 * Secondary MAC address is allocated from block
		 * 0x100000 higher then the first MAC address
		 */
		memcpy(ethaddr, &tdx_eth_addr, 6);
		ethaddr[3] += 0x10;
		eth_env_set_enetaddr("eth1addr", ethaddr);
	}
#endif

	printf("Model: Toradex %s %s, Serial# %s\n",
	       toradex_modules[tdx_hw_tag.prodid],
	       tdx_board_rev_str,
	       tdx_serial_str);

	return 0;
}

#ifdef CONFIG_USB_GADGET_DOWNLOAD
int g_dnl_bind_fixup(struct usb_device_descriptor *dev, const char *name)
{
	unsigned short usb_pid;

	usb_pid = TORADEX_USB_PRODUCT_NUM_OFFSET + tdx_hw_tag.prodid;
	put_unaligned(usb_pid, &dev->idProduct);

	return 0;
}
#endif

#if defined(CONFIG_OF_LIBFDT)
int ft_common_board_setup(void *blob, bd_t *bd)
{
	if (tdx_serial) {
		fdt_setprop(blob, 0, "serial-number", tdx_serial_str,
			    strlen(tdx_serial_str) + 1);
	}

	if (tdx_hw_tag.ver_major) {
		char prod_id[5];

		sprintf(prod_id, "%04u", tdx_hw_tag.prodid);
		fdt_setprop(blob, 0, "toradex,product-id", prod_id, 5);

		fdt_setprop(blob, 0, "toradex,board-rev", tdx_board_rev_str,
			    strlen(tdx_board_rev_str) + 1);
	}

	return 0;
}
#endif

#else /* CONFIG_TDX_CFG_BLOCK */

#ifdef CONFIG_REVISION_TAG
u32 get_board_rev(void)
{
	return 0;
}
#endif /* CONFIG_REVISION_TAG */

#ifdef CONFIG_SERIAL_TAG
u32 get_board_serial(void)
{
	return 0;
}
#endif /* CONFIG_SERIAL_TAG */

int ft_common_board_setup(void *blob, bd_t *bd)
{
	return 0;
}

#endif /* CONFIG_TDX_CFG_BLOCK */
Commit	Line	Data
a2777ecb MZ	1	/*
	2	* Copyright (c) 2016 Toradex, Inc.
	3	*
	4	* SPDX-License-Identifier: GPL-2.0+
	5	*/
	6
	7	#include <common.h>
	8	#include <g_dnl.h>
	9	#include <libfdt.h>
	10
	11	#include "tdx-cfg-block.h"
5d982856	12	#include <asm/setup.h>
a2777ecb MZ	13	#include "tdx-common.h"
	14
	15	#ifdef CONFIG_TDX_CFG_BLOCK
	16	static char tdx_serial_str[9];
	17	static char tdx_board_rev_str[6];
	18
	19	#ifdef CONFIG_REVISION_TAG
	20	u32 get_board_rev(void)
	21	{
	22	/* Check validity */
	23	if (!tdx_hw_tag.ver_major)
	24	return 0;
	25
	26	return ((tdx_hw_tag.ver_major & 0xff) << 8) \|
	27	((tdx_hw_tag.ver_minor & 0xf) << 4) \|
	28	((tdx_hw_tag.ver_assembly & 0xf) + 0xa);
	29	}
	30	#endif /* CONFIG_TDX_CFG_BLOCK */
	31
	32	#ifdef CONFIG_SERIAL_TAG
	33	void get_board_serial(struct tag_serialnr *serialnr)
	34	{
	35	int array[8];
	36	unsigned int serial = tdx_serial;
	37	int i;
	38
	39	serialnr->low = 0;
	40	serialnr->high = 0;
	41
	42	/* Check validity */
	43	if (serial) {
	44	/*
	45	* Convert to Linux serial number format (hexadecimal coded
	46	* decimal)
	47	*/
	48	i = 7;
	49	while (serial) {
	50	array[i--] = serial % 10;
	51	serial /= 10;
	52	}
	53	while (i >= 0)
	54	array[i--] = 0;
	55	serial = array[0];
	56	for (i = 1; i < 8; i++) {
	57	serial *= 16;
	58	serial += array[i];
	59	}
	60
	61	serialnr->low = serial;
	62	}
	63	}
	64	#endif /* CONFIG_SERIAL_TAG */
	65
	66	int show_board_info(void)
	67	{
	68	unsigned char ethaddr[6];
	69
	70	if (read_tdx_cfg_block()) {
	71	printf("Missing Toradex config block\n");
	72	checkboard();
	73	return 0;
	74	}
	75
	76	/* board serial-number */
77	sprintf(tdx_serial_str, "%08u", tdx_serial);
78	sprintf(tdx_board_rev_str, "V%1d.%1d%c",
79	tdx_hw_tag.ver_major,
80	tdx_hw_tag.ver_minor,
81	(char)tdx_hw_tag.ver_assembly + 'A');
82
382bee57	83	env_set("serial#", tdx_serial_str);
a2777ecb MZ	84
	85	/*
	86	* Check if environment contains a valid MAC address,
	87	* set the one from config block if not
	88	*/
35affd7a	89	if (!eth_env_get_enetaddr("ethaddr", ethaddr))
fd1e959e	90	eth_env_set_enetaddr("ethaddr", (u8 *)&tdx_eth_addr);
a2777ecb MZ	91
a2777ecb MZ	92	#ifdef CONFIG_TDX_CFG_BLOCK_2ND_ETHADDR
35affd7a	93	if (!eth_env_get_enetaddr("eth1addr", ethaddr)) {
a2777ecb MZ	94	/*
	95	* Secondary MAC address is allocated from block
	96	* 0x100000 higher then the first MAC address
	97	*/
	98	memcpy(ethaddr, &tdx_eth_addr, 6);
	99	ethaddr[3] += 0x10;
fd1e959e	100	eth_env_set_enetaddr("eth1addr", ethaddr);
a2777ecb MZ	101	}
	102	#endif
	103
	104	printf("Model: Toradex %s %s, Serial# %s\n",
	105	toradex_modules[tdx_hw_tag.prodid],
	106	tdx_board_rev_str,
	107	tdx_serial_str);
	108
	109	return 0;
	110	}
	111
beaf4068	112	#ifdef CONFIG_USB_GADGET_DOWNLOAD
a2777ecb MZ	113	int g_dnl_bind_fixup(struct usb_device_descriptor dev, const char name)
	114	{
	115	unsigned short usb_pid;
	116
	117	usb_pid = TORADEX_USB_PRODUCT_NUM_OFFSET + tdx_hw_tag.prodid;
	118	put_unaligned(usb_pid, &dev->idProduct);
	119
	120	return 0;
	121	}
beaf4068	122	#endif
a2777ecb	123
37fa4125 SA	124	#if defined(CONFIG_OF_LIBFDT)
37fa4125 SA	125	int ft_common_board_setup(void blob, bd_t bd)
a2777ecb MZ	126	{
	127	if (tdx_serial) {
	128	fdt_setprop(blob, 0, "serial-number", tdx_serial_str,
	129	strlen(tdx_serial_str) + 1);
	130	}
	131
	132	if (tdx_hw_tag.ver_major) {
	133	char prod_id[5];
	134
	135	sprintf(prod_id, "%04u", tdx_hw_tag.prodid);
	136	fdt_setprop(blob, 0, "toradex,product-id", prod_id, 5);
	137
	138	fdt_setprop(blob, 0, "toradex,board-rev", tdx_board_rev_str,
	139	strlen(tdx_board_rev_str) + 1);
	140	}
	141
	142	return 0;
	143	}
	144	#endif
	145
	146	#else /* CONFIG_TDX_CFG_BLOCK */
	147
	148	#ifdef CONFIG_REVISION_TAG
	149	u32 get_board_rev(void)
	150	{
	151	return 0;
	152	}
	153	#endif /* CONFIG_REVISION_TAG */
	154
	155	#ifdef CONFIG_SERIAL_TAG
	156	u32 get_board_serial(void)
	157	{
	158	return 0;
	159	}
	160	#endif /* CONFIG_SERIAL_TAG */
	161
37fa4125	162	int ft_common_board_setup(void blob, bd_t bd)
a2777ecb MZ	163	{
	164	return 0;
	165	}
a2777ecb MZ	166
a2777ecb MZ	167	#endif /* CONFIG_TDX_CFG_BLOCK */