1
2
3
4
5
6#include <linux/mfd/syscon.h>
7#include <linux/of.h>
8#include <linux/of_address.h>
9#include <linux/regmap.h>
10#include <linux/slab.h>
11#include <linux/sys_soc.h>
12
13#include <soc/imx/cpu.h>
14#include <soc/imx/revision.h>
15
16#define IIM_UID 0x820
17
18#define OCOTP_UID_H 0x420
19#define OCOTP_UID_L 0x410
20
21#define OCOTP_ULP_UID_1 0x4b0
22#define OCOTP_ULP_UID_2 0x4c0
23#define OCOTP_ULP_UID_3 0x4d0
24#define OCOTP_ULP_UID_4 0x4e0
25
26static int __init imx_soc_device_init(void)
27{
28 struct soc_device_attribute *soc_dev_attr;
29 const char *ocotp_compat = NULL;
30 struct soc_device *soc_dev;
31 struct device_node *root;
32 struct regmap *ocotp = NULL;
33 const char *soc_id;
34 u64 soc_uid = 0;
35 u32 val;
36 int ret;
37 int i;
38
39
40 if (!__mxc_cpu_type)
41 return 0;
42
43 soc_dev_attr = kzalloc(sizeof(*soc_dev_attr), GFP_KERNEL);
44 if (!soc_dev_attr)
45 return -ENOMEM;
46
47 soc_dev_attr->family = "Freescale i.MX";
48
49 root = of_find_node_by_path("/");
50 ret = of_property_read_string(root, "model", &soc_dev_attr->machine);
51 of_node_put(root);
52 if (ret)
53 goto free_soc;
54
55 switch (__mxc_cpu_type) {
56 case MXC_CPU_MX1:
57 soc_id = "i.MX1";
58 break;
59 case MXC_CPU_MX21:
60 soc_id = "i.MX21";
61 break;
62 case MXC_CPU_MX25:
63 soc_id = "i.MX25";
64 break;
65 case MXC_CPU_MX27:
66 soc_id = "i.MX27";
67 break;
68 case MXC_CPU_MX31:
69 soc_id = "i.MX31";
70 break;
71 case MXC_CPU_MX35:
72 soc_id = "i.MX35";
73 break;
74 case MXC_CPU_MX50:
75 soc_id = "i.MX50";
76 break;
77 case MXC_CPU_MX51:
78 ocotp_compat = "fsl,imx51-iim";
79 soc_id = "i.MX51";
80 break;
81 case MXC_CPU_MX53:
82 ocotp_compat = "fsl,imx53-iim";
83 soc_id = "i.MX53";
84 break;
85 case MXC_CPU_IMX6SL:
86 ocotp_compat = "fsl,imx6sl-ocotp";
87 soc_id = "i.MX6SL";
88 break;
89 case MXC_CPU_IMX6DL:
90 ocotp_compat = "fsl,imx6q-ocotp";
91 soc_id = "i.MX6DL";
92 break;
93 case MXC_CPU_IMX6SX:
94 ocotp_compat = "fsl,imx6sx-ocotp";
95 soc_id = "i.MX6SX";
96 break;
97 case MXC_CPU_IMX6Q:
98 ocotp_compat = "fsl,imx6q-ocotp";
99 soc_id = "i.MX6Q";
100 break;
101 case MXC_CPU_IMX6UL:
102 ocotp_compat = "fsl,imx6ul-ocotp";
103 soc_id = "i.MX6UL";
104 break;
105 case MXC_CPU_IMX6ULL:
106 ocotp_compat = "fsl,imx6ull-ocotp";
107 soc_id = "i.MX6ULL";
108 break;
109 case MXC_CPU_IMX6ULZ:
110 ocotp_compat = "fsl,imx6ull-ocotp";
111 soc_id = "i.MX6ULZ";
112 break;
113 case MXC_CPU_IMX6SLL:
114 ocotp_compat = "fsl,imx6sll-ocotp";
115 soc_id = "i.MX6SLL";
116 break;
117 case MXC_CPU_IMX7D:
118 ocotp_compat = "fsl,imx7d-ocotp";
119 soc_id = "i.MX7D";
120 break;
121 case MXC_CPU_IMX7ULP:
122 ocotp_compat = "fsl,imx7ulp-ocotp";
123 soc_id = "i.MX7ULP";
124 break;
125 case MXC_CPU_VF500:
126 ocotp_compat = "fsl,vf610-ocotp";
127 soc_id = "VF500";
128 break;
129 case MXC_CPU_VF510:
130 ocotp_compat = "fsl,vf610-ocotp";
131 soc_id = "VF510";
132 break;
133 case MXC_CPU_VF600:
134 ocotp_compat = "fsl,vf610-ocotp";
135 soc_id = "VF600";
136 break;
137 case MXC_CPU_VF610:
138 ocotp_compat = "fsl,vf610-ocotp";
139 soc_id = "VF610";
140 break;
141 default:
142 soc_id = "Unknown";
143 }
144 soc_dev_attr->soc_id = soc_id;
145
146 if (ocotp_compat) {
147 ocotp = syscon_regmap_lookup_by_compatible(ocotp_compat);
148 if (IS_ERR(ocotp))
149 pr_err("%s: failed to find %s regmap!\n", __func__, ocotp_compat);
150 }
151
152 if (!IS_ERR_OR_NULL(ocotp)) {
153 if (__mxc_cpu_type == MXC_CPU_IMX7ULP) {
154 regmap_read(ocotp, OCOTP_ULP_UID_4, &val);
155 soc_uid = val & 0xffff;
156 regmap_read(ocotp, OCOTP_ULP_UID_3, &val);
157 soc_uid <<= 16;
158 soc_uid |= val & 0xffff;
159 regmap_read(ocotp, OCOTP_ULP_UID_2, &val);
160 soc_uid <<= 16;
161 soc_uid |= val & 0xffff;
162 regmap_read(ocotp, OCOTP_ULP_UID_1, &val);
163 soc_uid <<= 16;
164 soc_uid |= val & 0xffff;
165 } else if (__mxc_cpu_type == MXC_CPU_MX51 ||
166 __mxc_cpu_type == MXC_CPU_MX53) {
167 for (i=0; i < 8; i++) {
168 regmap_read(ocotp, IIM_UID + i*4, &val);
169 soc_uid <<= 8;
170 soc_uid |= (val & 0xff);
171 }
172 } else {
173 regmap_read(ocotp, OCOTP_UID_H, &val);
174 soc_uid = val;
175 regmap_read(ocotp, OCOTP_UID_L, &val);
176 soc_uid <<= 32;
177 soc_uid |= val;
178 }
179 }
180
181 soc_dev_attr->revision = kasprintf(GFP_KERNEL, "%d.%d",
182 (imx_get_soc_revision() >> 4) & 0xf,
183 imx_get_soc_revision() & 0xf);
184 if (!soc_dev_attr->revision) {
185 ret = -ENOMEM;
186 goto free_soc;
187 }
188
189 soc_dev_attr->serial_number = kasprintf(GFP_KERNEL, "%016llX", soc_uid);
190 if (!soc_dev_attr->serial_number) {
191 ret = -ENOMEM;
192 goto free_rev;
193 }
194
195 soc_dev = soc_device_register(soc_dev_attr);
196 if (IS_ERR(soc_dev)) {
197 ret = PTR_ERR(soc_dev);
198 goto free_serial_number;
199 }
200
201 return 0;
202
203free_serial_number:
204 kfree(soc_dev_attr->serial_number);
205free_rev:
206 kfree(soc_dev_attr->revision);
207free_soc:
208 kfree(soc_dev_attr);
209 return ret;
210}
211device_initcall(imx_soc_device_init);
212
