blob: f1ab7946773ff5a2bae012a01a854136ab283a8b [file] [log] [blame]
Marcel Ziswiler7a28dfc2016-11-16 17:49:22 +01001/*
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
15static char tdx_serial_str[9];
16static char tdx_board_rev_str[6];
17
18#ifdef CONFIG_REVISION_TAG
19u32 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
32void 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
65int 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
112int 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)
124int 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
148u32 get_board_rev(void)
149{
150 return 0;
151}
152#endif /* CONFIG_REVISION_TAG */
153
154#ifdef CONFIG_SERIAL_TAG
155u32 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)
162int ft_board_setup(void *blob, bd_t *bd)
163{
164 return 0;
165}
166#endif
167
168#endif /* CONFIG_TDX_CFG_BLOCK */