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 <env.h>
   8 #include <g_dnl.h>
   9 #include <init.h>
  10 #include <linux/libfdt.h>
  11
  12 #ifdef CONFIG_VIDEO
  13 #include <bmp_logo.h>
  14 #include <dm.h>
  15 #include <splash.h>
  16 #include <video.h>
  17 #endif
  18
  19 #include "tdx-cfg-block.h"
  20 #include <asm/setup.h>
  21 #include "tdx-common.h"
  22
  23 #define SERIAL_STR_LEN 8
  24 #define MODULE_VER_STR_LEN 4 // V1.1
  25 #define MODULE_REV_STR_LEN 3 // [A-Z] or #[26-99]
  26
  27 #ifdef CONFIG_TDX_CFG_BLOCK
  28 static char tdx_serial_str[SERIAL_STR_LEN + 1];
  29 static char tdx_board_rev_str[MODULE_VER_STR_LEN + MODULE_REV_STR_LEN + 1];
  30
  31 #ifdef CONFIG_TDX_CFG_BLOCK_EXTRA
  32 static char tdx_car_serial_str[SERIAL_STR_LEN + 1];
  33 static char tdx_car_rev_str[MODULE_VER_STR_LEN + MODULE_REV_STR_LEN + 1];
  34 static const char *tdx_carrier_board_name;
  35 #endif
  36
  37 #if defined(CONFIG_ENV_VARS_UBOOT_RUNTIME_CONFIG)
  38 u32 get_board_revision(void)
  39 {
  40         /* Check validity */
  41         if (!tdx_hw_tag.ver_major)
  42                 return 0;
  43
  44         return ((tdx_hw_tag.ver_major & 0xff) << 8) |
  45                 ((tdx_hw_tag.ver_minor & 0xf) << 4) |
  46                 ((tdx_hw_tag.ver_assembly & 0xf) + 0xa);
  47 }
  48 #endif /* CONFIG_TDX_CFG_BLOCK */
  49
  50 #ifdef CONFIG_SERIAL_TAG
  51 void get_board_serial(struct tag_serialnr *serialnr)
  52 {
  53         int array[8];
  54         unsigned int serial = tdx_serial;
  55         int i;
  56
  57         serialnr->low = 0;
  58         serialnr->high = 0;
  59
  60         /* Check validity */
  61         if (serial) {
  62                 /*
  63                  * Convert to Linux serial number format (hexadecimal coded
  64                  * decimal)
  65                  */
  66                 i = 7;
  67                 while (serial) {
  68                         array[i--] = serial % 10;
  69                         serial /= 10;
  70                 }
  71                 while (i >= 0)
  72                         array[i--] = 0;
  73                 serial = array[0];
  74                 for (i = 1; i < 8; i++) {
  75                         serial *= 16;
  76                         serial += array[i];
  77                 }
  78
  79                 serialnr->low = serial;
  80         }
  81 }
  82 #endif /* CONFIG_SERIAL_TAG */
  83
  84 static const char *get_board_assembly(u16 ver_assembly)
  85 {
  86         static char ver_name[MODULE_REV_STR_LEN + 1];
  87
  88         if (ver_assembly < 26) {
  89                 ver_name[0] = (char)ver_assembly + 'A';
  90                 ver_name[1] = '\0';
  91         } else {
  92                 snprintf(ver_name, sizeof(ver_name),
  93                          "#%u", ver_assembly);
  94         }
  95
  96         return ver_name;
  97 }
  98
  99 int show_board_info(void)
 100 {
 101         unsigned char ethaddr[6];
 102
 103         if (read_tdx_cfg_block()) {
 104                 printf("MISSING TORADEX CONFIG BLOCK\n");
 105                 get_mac_from_serial(tdx_serial, &tdx_eth_addr);
 106                 checkboard();
 107         } else {
 108                 snprintf(tdx_serial_str, sizeof(tdx_serial_str),
 109                          "%08u", tdx_serial);
 110                 snprintf(tdx_board_rev_str, sizeof(tdx_board_rev_str),
 111                          "V%1d.%1d%s",
 112                          tdx_hw_tag.ver_major,
 113                          tdx_hw_tag.ver_minor,
 114                          get_board_assembly(tdx_hw_tag.ver_assembly));
 115
 116                 env_set("serial#", tdx_serial_str);
 117
 118                 printf("Model: Toradex %04d %s %s\n",
 119                        tdx_hw_tag.prodid,
 120                        toradex_modules[tdx_hw_tag.prodid].name,
 121                        tdx_board_rev_str);
 122                 printf("Serial#: %s\n", tdx_serial_str);
 123 #ifdef CONFIG_TDX_CFG_BLOCK_EXTRA
 124                 if (read_tdx_cfg_block_carrier()) {
 125                         printf("MISSING TORADEX CARRIER CONFIG BLOCKS\n");
 126                         try_migrate_tdx_cfg_block_carrier();
 127                 } else {
 128                         tdx_carrier_board_name =
 129                                 get_toradex_carrier_boards(tdx_car_hw_tag.prodid);
 130
 131                         snprintf(tdx_car_serial_str, sizeof(tdx_car_serial_str),
 132                                  "%08u", tdx_car_serial);
 133                         snprintf(tdx_car_rev_str, sizeof(tdx_car_rev_str),
 134                                  "V%1d.%1d%s",
 135                                  tdx_car_hw_tag.ver_major,
 136                                  tdx_car_hw_tag.ver_minor,
 137                                  get_board_assembly(tdx_car_hw_tag.ver_assembly));
 138
 139                         env_set("carrier_serial#", tdx_car_serial_str);
 140                         printf("Carrier: Toradex %s %s, Serial# %s\n",
 141                                tdx_carrier_board_name,
 142                                tdx_car_rev_str,
 143                                tdx_car_serial_str);
 144                 }
 145 #endif
 146         }
 147
 148         /*
 149          * Check if environment contains a valid MAC address,
 150          * set the one from config block if not
 151          */
 152         if (!eth_env_get_enetaddr("ethaddr", ethaddr))
 153                 eth_env_set_enetaddr("ethaddr", (u8 *)&tdx_eth_addr);
 154
 155         if (IS_ENABLED(CONFIG_TDX_CFG_BLOCK_2ND_ETHADDR) &&
 156             !eth_env_get_enetaddr("eth1addr", ethaddr)) {
 157                 /*
 158                  * Secondary MAC address is allocated from block
 159                  * 0x100000 higher then the first MAC address
 160                  */
 161                 memcpy(ethaddr, &tdx_eth_addr, 6);
 162                 ethaddr[3] += 0x10;
 163                 eth_env_set_enetaddr("eth1addr", ethaddr);
 164         }
 165
 166         return 0;
 167 }
 168
 169 #ifdef CONFIG_TDX_CFG_BLOCK_USB_GADGET_PID
 170 int g_dnl_bind_fixup(struct usb_device_descriptor *dev, const char *name)
 171 {
 172         unsigned short usb_pid;
 173
 174         usb_pid = TORADEX_USB_PRODUCT_NUM_OFFSET + tdx_hw_tag.prodid;
 175         put_unaligned(usb_pid, &dev->idProduct);
 176
 177         return 0;
 178 }
 179 #endif
 180
 181 #if defined(CONFIG_OF_LIBFDT)
 182 int ft_common_board_setup(void *blob, struct bd_info *bd)
 183 {
 184         if (tdx_serial) {
 185                 fdt_setprop(blob, 0, "serial-number", tdx_serial_str,
 186                             strlen(tdx_serial_str) + 1);
 187         }
 188
 189         if (tdx_hw_tag.ver_major) {
 190                 char prod_id[5];
 191
 192                 snprintf(prod_id, sizeof(prod_id), "%04u", tdx_hw_tag.prodid);
 193                 fdt_setprop(blob, 0, "toradex,product-id", prod_id, 5);
 194
 195                 fdt_setprop(blob, 0, "toradex,board-rev", tdx_board_rev_str,
 196                             strlen(tdx_board_rev_str) + 1);
 197         }
 198
 199         return 0;
 200 }
 201 #endif
 202
 203 #else /* CONFIG_TDX_CFG_BLOCK */
 204
 205 #if defined(CONFIG_ENV_VARS_UBOOT_RUNTIME_CONFIG)
 206 u32 get_board_revision(void)
 207 {
 208         return 0;
 209 }
 210 #endif /* CONFIG_REVISION_TAG */
 211
 212 #ifdef CONFIG_SERIAL_TAG
 213 u32 get_board_serial(void)
 214 {
 215         return 0;
 216 }
 217 #endif /* CONFIG_SERIAL_TAG */
 218
 219 int ft_common_board_setup(void *blob, struct bd_info *bd)
 220 {
 221         return 0;
 222 }
 223
 224 #endif /* CONFIG_TDX_CFG_BLOCK */