tlv_data.c 2.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * Copyright 2020 SolidRun
  4. */
  5. #include <common.h>
  6. #include <tlv_eeprom.h>
  7. #include "tlv_data.h"
  8. #define SR_TLV_CODE_RAM_SIZE 0x81
  9. static void store_product_name(struct tlvinfo_tlv *tlv_entry,
  10. struct tlv_data *td)
  11. {
  12. int len;
  13. char *dest;
  14. if (strlen(td->tlv_product_name[0]) == 0)
  15. dest = td->tlv_product_name[0];
  16. else if (strlen(td->tlv_product_name[1]) == 0)
  17. dest = td->tlv_product_name[1];
  18. else
  19. return;
  20. len = min_t(unsigned int, tlv_entry->length,
  21. sizeof(td->tlv_product_name[0]) - 1);
  22. memcpy(dest, tlv_entry->value, len);
  23. }
  24. static void parse_tlv_vendor_ext(struct tlvinfo_tlv *tlv_entry,
  25. struct tlv_data *td)
  26. {
  27. u8 *val = tlv_entry->value;
  28. u32 pen; /* IANA Private Enterprise Numbers */
  29. if (tlv_entry->length < 5) /* 4 bytes PEN + at least 1 byte type */
  30. return;
  31. /* PEN is big endian */
  32. pen = (val[0] << 24) | (val[1] << 16) | (val[2] << 8) | val[3];
  33. /* Not a real PEN */
  34. if (pen != 0xffffffff)
  35. return;
  36. if (val[4] != SR_TLV_CODE_RAM_SIZE)
  37. return;
  38. if (tlv_entry->length != 6)
  39. return;
  40. td->ram_size = val[5];
  41. }
  42. static void parse_tlv_data(u8 *eeprom, struct tlvinfo_header *hdr,
  43. struct tlvinfo_tlv *entry, struct tlv_data *td)
  44. {
  45. unsigned int tlv_offset, tlv_len;
  46. tlv_offset = sizeof(struct tlvinfo_header);
  47. tlv_len = sizeof(struct tlvinfo_header) + be16_to_cpu(hdr->totallen);
  48. while (tlv_offset < tlv_len) {
  49. entry = (struct tlvinfo_tlv *)&eeprom[tlv_offset];
  50. switch (entry->type) {
  51. case TLV_CODE_PRODUCT_NAME:
  52. store_product_name(entry, td);
  53. break;
  54. case TLV_CODE_VENDOR_EXT:
  55. parse_tlv_vendor_ext(entry, td);
  56. break;
  57. default:
  58. break;
  59. }
  60. tlv_offset += sizeof(struct tlvinfo_tlv) + entry->length;
  61. }
  62. }
  63. void read_tlv_data(struct tlv_data *td)
  64. {
  65. u8 eeprom_data[TLV_TOTAL_LEN_MAX];
  66. struct tlvinfo_header *tlv_hdr;
  67. struct tlvinfo_tlv *tlv_entry;
  68. int ret, i;
  69. for (i = 0; i < 2; i++) {
  70. ret = read_tlvinfo_tlv_eeprom(eeprom_data, &tlv_hdr,
  71. &tlv_entry, i);
  72. if (ret < 0)
  73. continue;
  74. parse_tlv_data(eeprom_data, tlv_hdr, tlv_entry, td);
  75. }
  76. }
  77. bool sr_product_is(const struct tlv_data *td, const char *product)
  78. {
  79. /* Allow prefix sub-string match */
  80. if (strncmp(td->tlv_product_name[0], product, strlen(product)) == 0)
  81. return true;
  82. if (strncmp(td->tlv_product_name[1], product, strlen(product)) == 0)
  83. return true;
  84. return false;
  85. }