1 | // SPDX-License-Identifier: GPL-2.0 |
2 | /* |
3 | * Copyright (c) 2023 MediaTek Inc. |
4 | */ |
5 | #include <linux/kernel.h> |
6 | #include <linux/module.h> |
7 | #include <linux/of.h> |
8 | #include <linux/of_platform.h> |
9 | #include <linux/pm_runtime.h> |
10 | #include <linux/nvmem-consumer.h> |
11 | #include <linux/device.h> |
12 | #include <linux/device/bus.h> |
13 | #include <linux/debugfs.h> |
14 | #include <linux/seq_file.h> |
15 | #include <linux/string.h> |
16 | #include <linux/sys_soc.h> |
17 | #include <linux/slab.h> |
18 | #include <linux/platform_device.h> |
19 | |
20 | #define MTK_SOCINFO_ENTRY(_soc_name, _segment_name, _marketing_name, _cell_data1, _cell_data2) {\ |
21 | .soc_name = _soc_name, \ |
22 | .segment_name = _segment_name, \ |
23 | .marketing_name = _marketing_name, \ |
24 | .cell_data = {_cell_data1, _cell_data2} \ |
25 | } |
26 | #define CELL_NOT_USED (0xFFFFFFFF) |
27 | #define MAX_CELLS (2) |
28 | |
29 | struct mtk_socinfo { |
30 | struct device *dev; |
31 | struct name_data *name_data; |
32 | struct socinfo_data *socinfo_data; |
33 | struct soc_device *soc_dev; |
34 | }; |
35 | |
36 | struct socinfo_data { |
37 | char *soc_name; |
38 | char *segment_name; |
39 | char *marketing_name; |
40 | u32 cell_data[MAX_CELLS]; |
41 | }; |
42 | |
43 | static const char *cell_names[MAX_CELLS] = {"socinfo-data1" , "socinfo-data2" }; |
44 | |
45 | static struct socinfo_data socinfo_data_table[] = { |
46 | MTK_SOCINFO_ENTRY("MT8173" , "MT8173V/AC" , "MT8173" , 0x6CA20004, 0x10000000), |
47 | MTK_SOCINFO_ENTRY("MT8183" , "MT8183V/AZA" , "Kompanio 500" , 0x00010043, 0x00000840), |
48 | MTK_SOCINFO_ENTRY("MT8183" , "MT8183V/AZA" , "Kompanio 500" , 0x00010043, 0x00000940), |
49 | MTK_SOCINFO_ENTRY("MT8186" , "MT8186GV/AZA" , "Kompanio 520" , 0x81861001, CELL_NOT_USED), |
50 | MTK_SOCINFO_ENTRY("MT8186T" , "MT8186TV/AZA" , "Kompanio 528" , 0x81862001, CELL_NOT_USED), |
51 | MTK_SOCINFO_ENTRY("MT8188" , "MT8188GV/AZA" , "Kompanio 830" , 0x81880000, 0x00000010), |
52 | MTK_SOCINFO_ENTRY("MT8188" , "MT8188GV/HZA" , "Kompanio 830" , 0x81880000, 0x00000011), |
53 | MTK_SOCINFO_ENTRY("MT8192" , "MT8192V/AZA" , "Kompanio 820" , 0x00001100, 0x00040080), |
54 | MTK_SOCINFO_ENTRY("MT8192T" , "MT8192V/ATZA" , "Kompanio 828" , 0x00000100, 0x000400C0), |
55 | MTK_SOCINFO_ENTRY("MT8195" , "MT8195GV/EZA" , "Kompanio 1200" , 0x81950300, CELL_NOT_USED), |
56 | MTK_SOCINFO_ENTRY("MT8195" , "MT8195GV/EHZA" , "Kompanio 1200" , 0x81950304, CELL_NOT_USED), |
57 | MTK_SOCINFO_ENTRY("MT8195" , "MT8195TV/EZA" , "Kompanio 1380" , 0x81950400, CELL_NOT_USED), |
58 | MTK_SOCINFO_ENTRY("MT8195" , "MT8195TV/EHZA" , "Kompanio 1380" , 0x81950404, CELL_NOT_USED), |
59 | }; |
60 | |
61 | static int mtk_socinfo_create_socinfo_node(struct mtk_socinfo *mtk_socinfop) |
62 | { |
63 | struct soc_device_attribute *attrs; |
64 | static char machine[30] = {0}; |
65 | static const char *soc_manufacturer = "MediaTek" ; |
66 | |
67 | attrs = devm_kzalloc(dev: mtk_socinfop->dev, size: sizeof(*attrs), GFP_KERNEL); |
68 | if (!attrs) |
69 | return -ENOMEM; |
70 | |
71 | snprintf(buf: machine, size: sizeof(machine), fmt: "%s (%s)" , mtk_socinfop->socinfo_data->marketing_name, |
72 | mtk_socinfop->socinfo_data->soc_name); |
73 | attrs->family = soc_manufacturer; |
74 | attrs->machine = machine; |
75 | |
76 | mtk_socinfop->soc_dev = soc_device_register(soc_plat_dev_attr: attrs); |
77 | if (IS_ERR(ptr: mtk_socinfop->soc_dev)) |
78 | return PTR_ERR(ptr: mtk_socinfop->soc_dev); |
79 | |
80 | dev_info(mtk_socinfop->dev, "%s %s SoC detected.\n" , soc_manufacturer, attrs->machine); |
81 | return 0; |
82 | } |
83 | |
84 | static u32 mtk_socinfo_read_cell(struct device *dev, const char *name) |
85 | { |
86 | struct nvmem_device *nvmemp; |
87 | struct device_node *np, *nvmem_node = dev->parent->of_node; |
88 | u32 offset; |
89 | u32 cell_val = CELL_NOT_USED; |
90 | |
91 | /* should never fail since the nvmem driver registers this child */ |
92 | nvmemp = nvmem_device_find(data: nvmem_node, match: device_match_of_node); |
93 | if (IS_ERR(ptr: nvmemp)) |
94 | goto out; |
95 | |
96 | np = of_get_child_by_name(node: nvmem_node, name); |
97 | if (!np) |
98 | goto put_device; |
99 | |
100 | if (of_property_read_u32_index(np, propname: "reg" , index: 0, out_value: &offset)) |
101 | goto put_node; |
102 | |
103 | nvmem_device_read(nvmem: nvmemp, offset, bytes: sizeof(cell_val), buf: &cell_val); |
104 | |
105 | put_node: |
106 | of_node_put(node: np); |
107 | put_device: |
108 | nvmem_device_put(nvmem: nvmemp); |
109 | out: |
110 | return cell_val; |
111 | } |
112 | |
113 | static int mtk_socinfo_get_socinfo_data(struct mtk_socinfo *mtk_socinfop) |
114 | { |
115 | unsigned int i, j; |
116 | unsigned int num_cell_data = 0; |
117 | u32 cell_data[MAX_CELLS] = {0}; |
118 | bool match_socinfo; |
119 | int match_socinfo_index = -1; |
120 | |
121 | for (i = 0; i < MAX_CELLS; i++) { |
122 | cell_data[i] = mtk_socinfo_read_cell(dev: mtk_socinfop->dev, name: cell_names[i]); |
123 | if (cell_data[i] != CELL_NOT_USED) |
124 | num_cell_data++; |
125 | else |
126 | break; |
127 | } |
128 | |
129 | if (!num_cell_data) |
130 | return -ENOENT; |
131 | |
132 | for (i = 0; i < ARRAY_SIZE(socinfo_data_table); i++) { |
133 | match_socinfo = true; |
134 | for (j = 0; j < num_cell_data; j++) { |
135 | if (cell_data[j] != socinfo_data_table[i].cell_data[j]) { |
136 | match_socinfo = false; |
137 | break; |
138 | } |
139 | } |
140 | if (match_socinfo) { |
141 | mtk_socinfop->socinfo_data = &(socinfo_data_table[i]); |
142 | match_socinfo_index = i; |
143 | break; |
144 | } |
145 | } |
146 | |
147 | return match_socinfo_index >= 0 ? match_socinfo_index : -ENOENT; |
148 | } |
149 | |
150 | static int mtk_socinfo_probe(struct platform_device *pdev) |
151 | { |
152 | struct mtk_socinfo *mtk_socinfop; |
153 | int ret; |
154 | |
155 | mtk_socinfop = devm_kzalloc(dev: &pdev->dev, size: sizeof(*mtk_socinfop), GFP_KERNEL); |
156 | if (!mtk_socinfop) |
157 | return -ENOMEM; |
158 | |
159 | mtk_socinfop->dev = &pdev->dev; |
160 | |
161 | ret = mtk_socinfo_get_socinfo_data(mtk_socinfop); |
162 | if (ret < 0) |
163 | return dev_err_probe(dev: mtk_socinfop->dev, err: ret, fmt: "Failed to get socinfo data\n" ); |
164 | |
165 | ret = mtk_socinfo_create_socinfo_node(mtk_socinfop); |
166 | if (ret) |
167 | return dev_err_probe(dev: mtk_socinfop->dev, err: ret, fmt: "Cannot create node\n" ); |
168 | |
169 | platform_set_drvdata(pdev, data: mtk_socinfop); |
170 | return 0; |
171 | } |
172 | |
173 | static void mtk_socinfo_remove(struct platform_device *pdev) |
174 | { |
175 | struct mtk_socinfo *mtk_socinfop = platform_get_drvdata(pdev); |
176 | |
177 | soc_device_unregister(soc_dev: mtk_socinfop->soc_dev); |
178 | } |
179 | |
180 | static struct platform_driver mtk_socinfo = { |
181 | .probe = mtk_socinfo_probe, |
182 | .remove_new = mtk_socinfo_remove, |
183 | .driver = { |
184 | .name = "mtk-socinfo" , |
185 | }, |
186 | }; |
187 | module_platform_driver(mtk_socinfo); |
188 | |
189 | MODULE_AUTHOR("William-TW LIN <william-tw.lin@mediatek.com>" ); |
190 | MODULE_DESCRIPTION("MediaTek socinfo driver" ); |
191 | MODULE_LICENSE("GPL" ); |
192 | |