meson-gx-socinfo.c 5.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208
  1. /*
  2. * Copyright (c) 2017 BayLibre, SAS
  3. * Author: Neil Armstrong <narmstrong@baylibre.com>
  4. *
  5. * SPDX-License-Identifier: GPL-2.0+
  6. */
  7. #include <linux/io.h>
  8. #include <linux/of.h>
  9. #include <linux/of_address.h>
  10. #include <linux/of_platform.h>
  11. #include <linux/platform_device.h>
  12. #include <linux/slab.h>
  13. #include <linux/sys_soc.h>
  14. #include <linux/bitfield.h>
  15. #include <linux/regmap.h>
  16. #include <linux/mfd/syscon.h>
  17. #define AO_SEC_SD_CFG8 0xe0
  18. #define AO_SEC_SOCINFO_OFFSET AO_SEC_SD_CFG8
  19. #define SOCINFO_MAJOR GENMASK(31, 24)
  20. #define SOCINFO_PACK GENMASK(23, 16)
  21. #define SOCINFO_MINOR GENMASK(15, 8)
  22. #define SOCINFO_MISC GENMASK(7, 0)
  23. static const struct meson_gx_soc_id {
  24. const char *name;
  25. unsigned int id;
  26. } soc_ids[] = {
  27. { "GXBB", 0x1f },
  28. { "GXTVBB", 0x20 },
  29. { "GXL", 0x21 },
  30. { "GXM", 0x22 },
  31. { "TXL", 0x23 },
  32. { "TXLX", 0x24 },
  33. { "AXG", 0x25 },
  34. { "GXLX", 0x26 },
  35. { "TXHD", 0x27 },
  36. { "G12A", 0x28 },
  37. { "G12B", 0x29 },
  38. { "SM1", 0x2b },
  39. { "A1", 0x2c },
  40. };
  41. static const struct meson_gx_package_id {
  42. const char *name;
  43. unsigned int major_id;
  44. unsigned int pack_id;
  45. unsigned int pack_mask;
  46. } soc_packages[] = {
  47. { "S905", 0x1f, 0, 0x20 }, /* pack_id != 0x20 */
  48. { "S905H", 0x1f, 0x3, 0xf }, /* pack_id & 0xf == 0x3 */
  49. { "S905M", 0x1f, 0x20, 0xf0 }, /* pack_id == 0x20 */
  50. { "S905D", 0x21, 0, 0xf0 },
  51. { "S905X", 0x21, 0x80, 0xf0 },
  52. { "S905W", 0x21, 0xa0, 0xf0 },
  53. { "S905L", 0x21, 0xc0, 0xf0 },
  54. { "S905M2", 0x21, 0xe0, 0xf0 },
  55. { "S805X", 0x21, 0x30, 0xf0 },
  56. { "S805Y", 0x21, 0xb0, 0xf0 },
  57. { "S912", 0x22, 0, 0x0 }, /* Only S912 is known for GXM */
  58. { "962X", 0x24, 0x10, 0xf0 },
  59. { "962E", 0x24, 0x20, 0xf0 },
  60. { "A113X", 0x25, 0x37, 0xff },
  61. { "A113D", 0x25, 0x22, 0xff },
  62. { "S905D2", 0x28, 0x10, 0xf0 },
  63. { "S905X2", 0x28, 0x40, 0xf0 },
  64. { "A311D", 0x29, 0x10, 0xf0 },
  65. { "S922X", 0x29, 0x40, 0xf0 },
  66. { "S905D3", 0x2b, 0x4, 0xf5 },
  67. { "S905X3", 0x2b, 0x5, 0xf5 },
  68. { "S905X3", 0x2b, 0x10, 0x3f },
  69. { "S905D3", 0x2b, 0x30, 0x3f },
  70. { "A113L", 0x2c, 0x0, 0xf8 },
  71. };
  72. static inline unsigned int socinfo_to_major(u32 socinfo)
  73. {
  74. return FIELD_GET(SOCINFO_MAJOR, socinfo);
  75. }
  76. static inline unsigned int socinfo_to_minor(u32 socinfo)
  77. {
  78. return FIELD_GET(SOCINFO_MINOR, socinfo);
  79. }
  80. static inline unsigned int socinfo_to_pack(u32 socinfo)
  81. {
  82. return FIELD_GET(SOCINFO_PACK, socinfo);
  83. }
  84. static inline unsigned int socinfo_to_misc(u32 socinfo)
  85. {
  86. return FIELD_GET(SOCINFO_MISC, socinfo);
  87. }
  88. static const char *socinfo_to_package_id(u32 socinfo)
  89. {
  90. unsigned int pack = socinfo_to_pack(socinfo);
  91. unsigned int major = socinfo_to_major(socinfo);
  92. int i;
  93. for (i = 0 ; i < ARRAY_SIZE(soc_packages) ; ++i) {
  94. if (soc_packages[i].major_id == major &&
  95. soc_packages[i].pack_id ==
  96. (pack & soc_packages[i].pack_mask))
  97. return soc_packages[i].name;
  98. }
  99. return "Unknown";
  100. }
  101. static const char *socinfo_to_soc_id(u32 socinfo)
  102. {
  103. unsigned int id = socinfo_to_major(socinfo);
  104. int i;
  105. for (i = 0 ; i < ARRAY_SIZE(soc_ids) ; ++i) {
  106. if (soc_ids[i].id == id)
  107. return soc_ids[i].name;
  108. }
  109. return "Unknown";
  110. }
  111. static int __init meson_gx_socinfo_init(void)
  112. {
  113. struct soc_device_attribute *soc_dev_attr;
  114. struct soc_device *soc_dev;
  115. struct device_node *np;
  116. struct regmap *regmap;
  117. unsigned int socinfo;
  118. struct device *dev;
  119. int ret;
  120. /* look up for chipid node */
  121. np = of_find_compatible_node(NULL, NULL, "amlogic,meson-gx-ao-secure");
  122. if (!np)
  123. return -ENODEV;
  124. /* check if interface is enabled */
  125. if (!of_device_is_available(np)) {
  126. of_node_put(np);
  127. return -ENODEV;
  128. }
  129. /* check if chip-id is available */
  130. if (!of_property_read_bool(np, "amlogic,has-chip-id")) {
  131. of_node_put(np);
  132. return -ENODEV;
  133. }
  134. /* node should be a syscon */
  135. regmap = syscon_node_to_regmap(np);
  136. of_node_put(np);
  137. if (IS_ERR(regmap)) {
  138. pr_err("%s: failed to get regmap\n", __func__);
  139. return -ENODEV;
  140. }
  141. ret = regmap_read(regmap, AO_SEC_SOCINFO_OFFSET, &socinfo);
  142. if (ret < 0)
  143. return ret;
  144. if (!socinfo) {
  145. pr_err("%s: invalid chipid value\n", __func__);
  146. return -EINVAL;
  147. }
  148. soc_dev_attr = kzalloc(sizeof(*soc_dev_attr), GFP_KERNEL);
  149. if (!soc_dev_attr)
  150. return -ENODEV;
  151. soc_dev_attr->family = "Amlogic Meson";
  152. np = of_find_node_by_path("/");
  153. of_property_read_string(np, "model", &soc_dev_attr->machine);
  154. of_node_put(np);
  155. soc_dev_attr->revision = kasprintf(GFP_KERNEL, "%x:%x - %x:%x",
  156. socinfo_to_major(socinfo),
  157. socinfo_to_minor(socinfo),
  158. socinfo_to_pack(socinfo),
  159. socinfo_to_misc(socinfo));
  160. soc_dev_attr->soc_id = kasprintf(GFP_KERNEL, "%s (%s)",
  161. socinfo_to_soc_id(socinfo),
  162. socinfo_to_package_id(socinfo));
  163. soc_dev = soc_device_register(soc_dev_attr);
  164. if (IS_ERR(soc_dev)) {
  165. kfree(soc_dev_attr->revision);
  166. kfree_const(soc_dev_attr->soc_id);
  167. kfree(soc_dev_attr);
  168. return PTR_ERR(soc_dev);
  169. }
  170. dev = soc_device_to_device(soc_dev);
  171. dev_info(dev, "Amlogic Meson %s Revision %x:%x (%x:%x) Detected\n",
  172. soc_dev_attr->soc_id,
  173. socinfo_to_major(socinfo),
  174. socinfo_to_minor(socinfo),
  175. socinfo_to_pack(socinfo),
  176. socinfo_to_misc(socinfo));
  177. return 0;
  178. }
  179. device_initcall(meson_gx_socinfo_init);