1 | // SPDX-License-Identifier: GPL-2.0 |
2 | /* |
3 | * Copyright 2019 NXP. |
4 | */ |
5 | |
6 | #include <dt-bindings/firmware/imx/rsrc.h> |
7 | #include <linux/firmware/imx/sci.h> |
8 | #include <linux/slab.h> |
9 | #include <linux/sys_soc.h> |
10 | #include <linux/platform_device.h> |
11 | #include <linux/of.h> |
12 | |
13 | static struct imx_sc_ipc *imx_sc_soc_ipc_handle; |
14 | |
15 | struct imx_sc_msg_misc_get_soc_id { |
16 | struct imx_sc_rpc_msg hdr; |
17 | union { |
18 | struct { |
19 | u32 control; |
20 | u16 resource; |
21 | } __packed req; |
22 | struct { |
23 | u32 id; |
24 | } resp; |
25 | } data; |
26 | } __packed __aligned(4); |
27 | |
28 | struct imx_sc_msg_misc_get_soc_uid { |
29 | struct imx_sc_rpc_msg hdr; |
30 | u32 uid_low; |
31 | u32 uid_high; |
32 | } __packed; |
33 | |
34 | static int imx_scu_soc_uid(u64 *soc_uid) |
35 | { |
36 | struct imx_sc_msg_misc_get_soc_uid msg; |
37 | struct imx_sc_rpc_msg *hdr = &msg.hdr; |
38 | int ret; |
39 | |
40 | hdr->ver = IMX_SC_RPC_VERSION; |
41 | hdr->svc = IMX_SC_RPC_SVC_MISC; |
42 | hdr->func = IMX_SC_MISC_FUNC_UNIQUE_ID; |
43 | hdr->size = 1; |
44 | |
45 | ret = imx_scu_call_rpc(ipc: imx_sc_soc_ipc_handle, msg: &msg, have_resp: true); |
46 | if (ret) { |
47 | pr_err("%s: get soc uid failed, ret %d\n" , __func__, ret); |
48 | return ret; |
49 | } |
50 | |
51 | *soc_uid = msg.uid_high; |
52 | *soc_uid <<= 32; |
53 | *soc_uid |= msg.uid_low; |
54 | |
55 | return 0; |
56 | } |
57 | |
58 | static int imx_scu_soc_id(void) |
59 | { |
60 | struct imx_sc_msg_misc_get_soc_id msg; |
61 | struct imx_sc_rpc_msg *hdr = &msg.hdr; |
62 | int ret; |
63 | |
64 | hdr->ver = IMX_SC_RPC_VERSION; |
65 | hdr->svc = IMX_SC_RPC_SVC_MISC; |
66 | hdr->func = IMX_SC_MISC_FUNC_GET_CONTROL; |
67 | hdr->size = 3; |
68 | |
69 | msg.data.req.control = IMX_SC_C_ID; |
70 | msg.data.req.resource = IMX_SC_R_SYSTEM; |
71 | |
72 | ret = imx_scu_call_rpc(ipc: imx_sc_soc_ipc_handle, msg: &msg, have_resp: true); |
73 | if (ret) { |
74 | pr_err("%s: get soc info failed, ret %d\n" , __func__, ret); |
75 | return ret; |
76 | } |
77 | |
78 | return msg.data.resp.id; |
79 | } |
80 | |
81 | static const char *imx_scu_soc_name(u32 id) |
82 | { |
83 | switch (id) { |
84 | case 0x1: |
85 | return "i.MX8QM" ; |
86 | case 0x2: |
87 | return "i.MX8QXP" ; |
88 | case 0xe: |
89 | return "i.MX8DXL" ; |
90 | default: |
91 | break; |
92 | } |
93 | |
94 | return "NULL" ; |
95 | } |
96 | |
97 | int imx_scu_soc_init(struct device *dev) |
98 | { |
99 | struct soc_device_attribute *soc_dev_attr; |
100 | struct soc_device *soc_dev; |
101 | int id, ret; |
102 | u64 uid = 0; |
103 | u32 val; |
104 | |
105 | ret = imx_scu_get_handle(ipc: &imx_sc_soc_ipc_handle); |
106 | if (ret) |
107 | return ret; |
108 | |
109 | soc_dev_attr = devm_kzalloc(dev, size: sizeof(*soc_dev_attr), |
110 | GFP_KERNEL); |
111 | if (!soc_dev_attr) |
112 | return -ENOMEM; |
113 | |
114 | soc_dev_attr->family = "Freescale i.MX" ; |
115 | |
116 | ret = of_property_read_string(np: of_root, |
117 | propname: "model" , |
118 | out_string: &soc_dev_attr->machine); |
119 | if (ret) |
120 | return ret; |
121 | |
122 | id = imx_scu_soc_id(); |
123 | if (id < 0) |
124 | return -EINVAL; |
125 | |
126 | ret = imx_scu_soc_uid(soc_uid: &uid); |
127 | if (ret < 0) |
128 | return -EINVAL; |
129 | |
130 | /* format soc_id value passed from SCU firmware */ |
131 | val = id & 0x1f; |
132 | soc_dev_attr->soc_id = imx_scu_soc_name(id: val); |
133 | |
134 | /* format revision value passed from SCU firmware */ |
135 | val = (id >> 5) & 0xf; |
136 | val = (((val >> 2) + 1) << 4) | (val & 0x3); |
137 | soc_dev_attr->revision = devm_kasprintf(dev, GFP_KERNEL, fmt: "%d.%d" , |
138 | (val >> 4) & 0xf, val & 0xf); |
139 | if (!soc_dev_attr->revision) |
140 | return -ENOMEM; |
141 | |
142 | soc_dev_attr->serial_number = devm_kasprintf(dev, GFP_KERNEL, |
143 | fmt: "%016llX" , uid); |
144 | if (!soc_dev_attr->serial_number) |
145 | return -ENOMEM; |
146 | |
147 | soc_dev = soc_device_register(soc_plat_dev_attr: soc_dev_attr); |
148 | if (IS_ERR(ptr: soc_dev)) |
149 | return PTR_ERR(ptr: soc_dev); |
150 | |
151 | return 0; |
152 | } |
153 | |