1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-only
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun * Copyright © 2014 NVIDIA Corporation
4*4882a593Smuzhiyun * Copyright © 2015 Broadcom Corporation
5*4882a593Smuzhiyun */
6*4882a593Smuzhiyun
7*4882a593Smuzhiyun #include <linux/io.h>
8*4882a593Smuzhiyun #include <linux/of.h>
9*4882a593Smuzhiyun #include <linux/of_address.h>
10*4882a593Smuzhiyun #include <linux/slab.h>
11*4882a593Smuzhiyun #include <linux/soc/brcmstb/brcmstb.h>
12*4882a593Smuzhiyun #include <linux/sys_soc.h>
13*4882a593Smuzhiyun
14*4882a593Smuzhiyun #include <soc/brcmstb/common.h>
15*4882a593Smuzhiyun
16*4882a593Smuzhiyun static u32 family_id;
17*4882a593Smuzhiyun static u32 product_id;
18*4882a593Smuzhiyun
19*4882a593Smuzhiyun static const struct of_device_id brcmstb_machine_match[] = {
20*4882a593Smuzhiyun { .compatible = "brcm,brcmstb", },
21*4882a593Smuzhiyun { }
22*4882a593Smuzhiyun };
23*4882a593Smuzhiyun
soc_is_brcmstb(void)24*4882a593Smuzhiyun bool soc_is_brcmstb(void)
25*4882a593Smuzhiyun {
26*4882a593Smuzhiyun const struct of_device_id *match;
27*4882a593Smuzhiyun struct device_node *root;
28*4882a593Smuzhiyun
29*4882a593Smuzhiyun root = of_find_node_by_path("/");
30*4882a593Smuzhiyun if (!root)
31*4882a593Smuzhiyun return false;
32*4882a593Smuzhiyun
33*4882a593Smuzhiyun match = of_match_node(brcmstb_machine_match, root);
34*4882a593Smuzhiyun of_node_put(root);
35*4882a593Smuzhiyun
36*4882a593Smuzhiyun return match != NULL;
37*4882a593Smuzhiyun }
38*4882a593Smuzhiyun
brcmstb_get_family_id(void)39*4882a593Smuzhiyun u32 brcmstb_get_family_id(void)
40*4882a593Smuzhiyun {
41*4882a593Smuzhiyun return family_id;
42*4882a593Smuzhiyun }
43*4882a593Smuzhiyun EXPORT_SYMBOL(brcmstb_get_family_id);
44*4882a593Smuzhiyun
brcmstb_get_product_id(void)45*4882a593Smuzhiyun u32 brcmstb_get_product_id(void)
46*4882a593Smuzhiyun {
47*4882a593Smuzhiyun return product_id;
48*4882a593Smuzhiyun }
49*4882a593Smuzhiyun EXPORT_SYMBOL(brcmstb_get_product_id);
50*4882a593Smuzhiyun
51*4882a593Smuzhiyun static const struct of_device_id sun_top_ctrl_match[] = {
52*4882a593Smuzhiyun { .compatible = "brcm,bcm7125-sun-top-ctrl", },
53*4882a593Smuzhiyun { .compatible = "brcm,bcm7346-sun-top-ctrl", },
54*4882a593Smuzhiyun { .compatible = "brcm,bcm7358-sun-top-ctrl", },
55*4882a593Smuzhiyun { .compatible = "brcm,bcm7360-sun-top-ctrl", },
56*4882a593Smuzhiyun { .compatible = "brcm,bcm7362-sun-top-ctrl", },
57*4882a593Smuzhiyun { .compatible = "brcm,bcm7420-sun-top-ctrl", },
58*4882a593Smuzhiyun { .compatible = "brcm,bcm7425-sun-top-ctrl", },
59*4882a593Smuzhiyun { .compatible = "brcm,bcm7429-sun-top-ctrl", },
60*4882a593Smuzhiyun { .compatible = "brcm,bcm7435-sun-top-ctrl", },
61*4882a593Smuzhiyun { .compatible = "brcm,brcmstb-sun-top-ctrl", },
62*4882a593Smuzhiyun { }
63*4882a593Smuzhiyun };
64*4882a593Smuzhiyun
brcmstb_soc_device_early_init(void)65*4882a593Smuzhiyun static int __init brcmstb_soc_device_early_init(void)
66*4882a593Smuzhiyun {
67*4882a593Smuzhiyun struct device_node *sun_top_ctrl;
68*4882a593Smuzhiyun void __iomem *sun_top_ctrl_base;
69*4882a593Smuzhiyun int ret = 0;
70*4882a593Smuzhiyun
71*4882a593Smuzhiyun /* We could be on a multi-platform kernel, don't make this fatal but
72*4882a593Smuzhiyun * bail out early
73*4882a593Smuzhiyun */
74*4882a593Smuzhiyun sun_top_ctrl = of_find_matching_node(NULL, sun_top_ctrl_match);
75*4882a593Smuzhiyun if (!sun_top_ctrl)
76*4882a593Smuzhiyun return ret;
77*4882a593Smuzhiyun
78*4882a593Smuzhiyun sun_top_ctrl_base = of_iomap(sun_top_ctrl, 0);
79*4882a593Smuzhiyun if (!sun_top_ctrl_base) {
80*4882a593Smuzhiyun ret = -ENODEV;
81*4882a593Smuzhiyun goto out;
82*4882a593Smuzhiyun }
83*4882a593Smuzhiyun
84*4882a593Smuzhiyun family_id = readl(sun_top_ctrl_base);
85*4882a593Smuzhiyun product_id = readl(sun_top_ctrl_base + 0x4);
86*4882a593Smuzhiyun iounmap(sun_top_ctrl_base);
87*4882a593Smuzhiyun out:
88*4882a593Smuzhiyun of_node_put(sun_top_ctrl);
89*4882a593Smuzhiyun return ret;
90*4882a593Smuzhiyun }
91*4882a593Smuzhiyun early_initcall(brcmstb_soc_device_early_init);
92*4882a593Smuzhiyun
brcmstb_soc_device_init(void)93*4882a593Smuzhiyun static int __init brcmstb_soc_device_init(void)
94*4882a593Smuzhiyun {
95*4882a593Smuzhiyun struct soc_device_attribute *soc_dev_attr;
96*4882a593Smuzhiyun struct device_node *sun_top_ctrl;
97*4882a593Smuzhiyun struct soc_device *soc_dev;
98*4882a593Smuzhiyun int ret = 0;
99*4882a593Smuzhiyun
100*4882a593Smuzhiyun /* We could be on a multi-platform kernel, don't make this fatal but
101*4882a593Smuzhiyun * bail out early
102*4882a593Smuzhiyun */
103*4882a593Smuzhiyun sun_top_ctrl = of_find_matching_node(NULL, sun_top_ctrl_match);
104*4882a593Smuzhiyun if (!sun_top_ctrl)
105*4882a593Smuzhiyun return ret;
106*4882a593Smuzhiyun
107*4882a593Smuzhiyun soc_dev_attr = kzalloc(sizeof(*soc_dev_attr), GFP_KERNEL);
108*4882a593Smuzhiyun if (!soc_dev_attr) {
109*4882a593Smuzhiyun ret = -ENOMEM;
110*4882a593Smuzhiyun goto out;
111*4882a593Smuzhiyun }
112*4882a593Smuzhiyun
113*4882a593Smuzhiyun soc_dev_attr->family = kasprintf(GFP_KERNEL, "%x",
114*4882a593Smuzhiyun family_id >> 28 ?
115*4882a593Smuzhiyun family_id >> 16 : family_id >> 8);
116*4882a593Smuzhiyun soc_dev_attr->soc_id = kasprintf(GFP_KERNEL, "%x",
117*4882a593Smuzhiyun product_id >> 28 ?
118*4882a593Smuzhiyun product_id >> 16 : product_id >> 8);
119*4882a593Smuzhiyun soc_dev_attr->revision = kasprintf(GFP_KERNEL, "%c%d",
120*4882a593Smuzhiyun ((product_id & 0xf0) >> 4) + 'A',
121*4882a593Smuzhiyun product_id & 0xf);
122*4882a593Smuzhiyun
123*4882a593Smuzhiyun soc_dev = soc_device_register(soc_dev_attr);
124*4882a593Smuzhiyun if (IS_ERR(soc_dev)) {
125*4882a593Smuzhiyun kfree(soc_dev_attr->family);
126*4882a593Smuzhiyun kfree(soc_dev_attr->soc_id);
127*4882a593Smuzhiyun kfree(soc_dev_attr->revision);
128*4882a593Smuzhiyun kfree(soc_dev_attr);
129*4882a593Smuzhiyun ret = -ENOMEM;
130*4882a593Smuzhiyun }
131*4882a593Smuzhiyun out:
132*4882a593Smuzhiyun of_node_put(sun_top_ctrl);
133*4882a593Smuzhiyun return ret;
134*4882a593Smuzhiyun }
135*4882a593Smuzhiyun arch_initcall(brcmstb_soc_device_init);
136