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
29struct 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
36struct socinfo_data {
37 char *soc_name;
38 char *segment_name;
39 char *marketing_name;
40 u32 cell_data[MAX_CELLS];
41};
42
43static const char *cell_names[MAX_CELLS] = {"socinfo-data1", "socinfo-data2"};
44
45static 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
61static 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
84static 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
105put_node:
106 of_node_put(node: np);
107put_device:
108 nvmem_device_put(nvmem: nvmemp);
109out:
110 return cell_val;
111}
112
113static 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
150static 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
173static 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
180static struct platform_driver mtk_socinfo = {
181 .probe = mtk_socinfo_probe,
182 .remove_new = mtk_socinfo_remove,
183 .driver = {
184 .name = "mtk-socinfo",
185 },
186};
187module_platform_driver(mtk_socinfo);
188
189MODULE_AUTHOR("William-TW LIN <william-tw.lin@mediatek.com>");
190MODULE_DESCRIPTION("MediaTek socinfo driver");
191MODULE_LICENSE("GPL");
192

source code of linux/drivers/soc/mediatek/mtk-socinfo.c