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