1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * Copyright (C) 2014 Linaro Ltd.
4 *
5 * Author: Linus Walleij <linus.walleij@linaro.org>
6 */
7 #include <linux/init.h>
8 #include <linux/io.h>
9 #include <linux/slab.h>
10 #include <linux/sys_soc.h>
11 #include <linux/platform_device.h>
12 #include <linux/mfd/syscon.h>
13 #include <linux/regmap.h>
14 #include <linux/of.h>
15
16 #define INTEGRATOR_HDR_ID_OFFSET 0x00
17
18 static u32 integrator_coreid;
19
20 static const struct of_device_id integrator_cm_match[] = {
21 { .compatible = "arm,core-module-integrator", },
22 { }
23 };
24
integrator_arch_str(u32 id)25 static const char *integrator_arch_str(u32 id)
26 {
27 switch ((id >> 16) & 0xff) {
28 case 0x00:
29 return "ASB little-endian";
30 case 0x01:
31 return "AHB little-endian";
32 case 0x03:
33 return "AHB-Lite system bus, bi-endian";
34 case 0x04:
35 return "AHB";
36 case 0x08:
37 return "AHB system bus, ASB processor bus";
38 default:
39 return "Unknown";
40 }
41 }
42
integrator_fpga_str(u32 id)43 static const char *integrator_fpga_str(u32 id)
44 {
45 switch ((id >> 12) & 0xf) {
46 case 0x01:
47 return "XC4062";
48 case 0x02:
49 return "XC4085";
50 case 0x03:
51 return "XVC600";
52 case 0x04:
53 return "EPM7256AE (Altera PLD)";
54 default:
55 return "Unknown";
56 }
57 }
58
integrator_get_manf(struct device * dev,struct device_attribute * attr,char * buf)59 static ssize_t integrator_get_manf(struct device *dev,
60 struct device_attribute *attr,
61 char *buf)
62 {
63 return sprintf(buf, "%02x\n", integrator_coreid >> 24);
64 }
65
66 static struct device_attribute integrator_manf_attr =
67 __ATTR(manufacturer, S_IRUGO, integrator_get_manf, NULL);
68
integrator_get_arch(struct device * dev,struct device_attribute * attr,char * buf)69 static ssize_t integrator_get_arch(struct device *dev,
70 struct device_attribute *attr,
71 char *buf)
72 {
73 return sprintf(buf, "%s\n", integrator_arch_str(integrator_coreid));
74 }
75
76 static struct device_attribute integrator_arch_attr =
77 __ATTR(arch, S_IRUGO, integrator_get_arch, NULL);
78
integrator_get_fpga(struct device * dev,struct device_attribute * attr,char * buf)79 static ssize_t integrator_get_fpga(struct device *dev,
80 struct device_attribute *attr,
81 char *buf)
82 {
83 return sprintf(buf, "%s\n", integrator_fpga_str(integrator_coreid));
84 }
85
86 static struct device_attribute integrator_fpga_attr =
87 __ATTR(fpga, S_IRUGO, integrator_get_fpga, NULL);
88
integrator_get_build(struct device * dev,struct device_attribute * attr,char * buf)89 static ssize_t integrator_get_build(struct device *dev,
90 struct device_attribute *attr,
91 char *buf)
92 {
93 return sprintf(buf, "%02x\n", (integrator_coreid >> 4) & 0xFF);
94 }
95
96 static struct device_attribute integrator_build_attr =
97 __ATTR(build, S_IRUGO, integrator_get_build, NULL);
98
integrator_soc_init(void)99 static int __init integrator_soc_init(void)
100 {
101 static struct regmap *syscon_regmap;
102 struct soc_device *soc_dev;
103 struct soc_device_attribute *soc_dev_attr;
104 struct device_node *np;
105 struct device *dev;
106 u32 val;
107 int ret;
108
109 np = of_find_matching_node(NULL, integrator_cm_match);
110 if (!np)
111 return -ENODEV;
112
113 syscon_regmap = syscon_node_to_regmap(np);
114 if (IS_ERR(syscon_regmap))
115 return PTR_ERR(syscon_regmap);
116
117 ret = regmap_read(syscon_regmap, INTEGRATOR_HDR_ID_OFFSET,
118 &val);
119 if (ret)
120 return -ENODEV;
121 integrator_coreid = val;
122
123 soc_dev_attr = kzalloc(sizeof(*soc_dev_attr), GFP_KERNEL);
124 if (!soc_dev_attr)
125 return -ENOMEM;
126
127 soc_dev_attr->soc_id = "Integrator";
128 soc_dev_attr->machine = "Integrator";
129 soc_dev_attr->family = "Versatile";
130 soc_dev = soc_device_register(soc_dev_attr);
131 if (IS_ERR(soc_dev)) {
132 kfree(soc_dev_attr);
133 return -ENODEV;
134 }
135 dev = soc_device_to_device(soc_dev);
136
137 device_create_file(dev, &integrator_manf_attr);
138 device_create_file(dev, &integrator_arch_attr);
139 device_create_file(dev, &integrator_fpga_attr);
140 device_create_file(dev, &integrator_build_attr);
141
142 dev_info(dev, "Detected ARM core module:\n");
143 dev_info(dev, " Manufacturer: %02x\n", (val >> 24));
144 dev_info(dev, " Architecture: %s\n", integrator_arch_str(val));
145 dev_info(dev, " FPGA: %s\n", integrator_fpga_str(val));
146 dev_info(dev, " Build: %02x\n", (val >> 4) & 0xFF);
147 dev_info(dev, " Rev: %c\n", ('A' + (val & 0x03)));
148
149 return 0;
150 }
151 device_initcall(integrator_soc_init);
152
