tdx-common.c 3.4 KB

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