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