board/toradex/common/tdx-common.c

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