1
2
3
4
5
6
7
8
9#include <linux/clk.h>
10#include <linux/module.h>
11#include <linux/devfreq-event.h>
12#include <linux/kernel.h>
13#include <linux/of_address.h>
14#include <linux/platform_device.h>
15#include <linux/regmap.h>
16
17#include "exynos-nocp.h"
18
19struct exynos_nocp {
20 struct devfreq_event_dev *edev;
21 struct devfreq_event_desc desc;
22
23 struct device *dev;
24
25 struct regmap *regmap;
26 struct clk *clk;
27};
28
29
30
31
32static int exynos_nocp_set_event(struct devfreq_event_dev *edev)
33{
34 struct exynos_nocp *nocp = devfreq_event_get_drvdata(edev);
35 int ret;
36
37
38 ret = regmap_update_bits(nocp->regmap, NOCP_MAIN_CTL,
39 NOCP_MAIN_CTL_STATEN_MASK, 0);
40 if (ret < 0) {
41 dev_err(nocp->dev, "failed to disable the NoC probe device\n");
42 return ret;
43 }
44
45
46 ret = regmap_write(nocp->regmap, NOCP_STAT_PERIOD, 0x0);
47 if (ret < 0)
48 goto out;
49
50
51 ret = regmap_update_bits(nocp->regmap, NOCP_COUNTERS_0_SRC,
52 NOCP_CNT_SRC_INTEVENT_MASK,
53 NOCP_CNT_SRC_INTEVENT_BYTE_MASK);
54 if (ret < 0)
55 goto out;
56
57 ret = regmap_update_bits(nocp->regmap, NOCP_COUNTERS_1_SRC,
58 NOCP_CNT_SRC_INTEVENT_MASK,
59 NOCP_CNT_SRC_INTEVENT_CHAIN_MASK);
60 if (ret < 0)
61 goto out;
62
63 ret = regmap_update_bits(nocp->regmap, NOCP_COUNTERS_2_SRC,
64 NOCP_CNT_SRC_INTEVENT_MASK,
65 NOCP_CNT_SRC_INTEVENT_CYCLE_MASK);
66 if (ret < 0)
67 goto out;
68
69 ret = regmap_update_bits(nocp->regmap, NOCP_COUNTERS_3_SRC,
70 NOCP_CNT_SRC_INTEVENT_MASK,
71 NOCP_CNT_SRC_INTEVENT_CHAIN_MASK);
72 if (ret < 0)
73 goto out;
74
75
76
77 ret = regmap_write(nocp->regmap, NOCP_STAT_ALARM_MIN, 0x0);
78 if (ret < 0)
79 goto out;
80
81 ret = regmap_write(nocp->regmap, NOCP_STAT_ALARM_MAX, 0x0);
82 if (ret < 0)
83 goto out;
84
85
86 ret = regmap_update_bits(nocp->regmap, NOCP_COUNTERS_0_ALARM_MODE,
87 NOCP_CNT_ALARM_MODE_MASK,
88 NOCP_CNT_ALARM_MODE_MIN_MAX_MASK);
89 if (ret < 0)
90 goto out;
91
92 ret = regmap_update_bits(nocp->regmap, NOCP_COUNTERS_1_ALARM_MODE,
93 NOCP_CNT_ALARM_MODE_MASK,
94 NOCP_CNT_ALARM_MODE_MIN_MAX_MASK);
95 if (ret < 0)
96 goto out;
97
98 ret = regmap_update_bits(nocp->regmap, NOCP_COUNTERS_2_ALARM_MODE,
99 NOCP_CNT_ALARM_MODE_MASK,
100 NOCP_CNT_ALARM_MODE_MIN_MAX_MASK);
101 if (ret < 0)
102 goto out;
103
104 ret = regmap_update_bits(nocp->regmap, NOCP_COUNTERS_3_ALARM_MODE,
105 NOCP_CNT_ALARM_MODE_MASK,
106 NOCP_CNT_ALARM_MODE_MIN_MAX_MASK);
107 if (ret < 0)
108 goto out;
109
110
111 ret = regmap_update_bits(nocp->regmap, NOCP_MAIN_CTL,
112 NOCP_MAIN_CTL_STATEN_MASK | NOCP_MAIN_CTL_ALARMEN_MASK,
113 NOCP_MAIN_CTL_STATEN_MASK | NOCP_MAIN_CTL_ALARMEN_MASK);
114 if (ret < 0)
115 goto out;
116
117
118 ret = regmap_update_bits(nocp->regmap, NOCP_CFG_CTL,
119 NOCP_CFG_CTL_GLOBALEN_MASK,
120 NOCP_CFG_CTL_GLOBALEN_MASK);
121 if (ret < 0)
122 goto out;
123
124
125 ret = regmap_update_bits(nocp->regmap, NOCP_MAIN_CTL,
126 NOCP_MAIN_CTL_STATEN_MASK,
127 NOCP_MAIN_CTL_STATEN_MASK);
128 if (ret < 0)
129 goto out;
130
131 return 0;
132
133out:
134
135 if (regmap_update_bits(nocp->regmap, NOCP_MAIN_CTL,
136 NOCP_MAIN_CTL_STATEN_MASK, 0)) {
137 dev_err(nocp->dev, "Failed to reset NoC probe device\n");
138 }
139
140 return ret;
141}
142
143static int exynos_nocp_get_event(struct devfreq_event_dev *edev,
144 struct devfreq_event_data *edata)
145{
146 struct exynos_nocp *nocp = devfreq_event_get_drvdata(edev);
147 unsigned int counter[4];
148 int ret;
149
150
151 ret = regmap_read(nocp->regmap, NOCP_COUNTERS_0_VAL, &counter[0]);
152 if (ret < 0)
153 goto out;
154
155 ret = regmap_read(nocp->regmap, NOCP_COUNTERS_1_VAL, &counter[1]);
156 if (ret < 0)
157 goto out;
158
159 ret = regmap_read(nocp->regmap, NOCP_COUNTERS_2_VAL, &counter[2]);
160 if (ret < 0)
161 goto out;
162
163 ret = regmap_read(nocp->regmap, NOCP_COUNTERS_3_VAL, &counter[3]);
164 if (ret < 0)
165 goto out;
166
167 edata->load_count = ((counter[1] << 16) | counter[0]);
168 edata->total_count = ((counter[3] << 16) | counter[2]);
169
170 dev_dbg(&edev->dev, "%s (event: %ld/%ld)\n", edev->desc->name,
171 edata->load_count, edata->total_count);
172
173 return 0;
174
175out:
176 dev_err(nocp->dev, "Failed to read the counter of NoC probe device\n");
177
178 return ret;
179}
180
181static const struct devfreq_event_ops exynos_nocp_ops = {
182 .set_event = exynos_nocp_set_event,
183 .get_event = exynos_nocp_get_event,
184};
185
186static const struct of_device_id exynos_nocp_id_match[] = {
187 { .compatible = "samsung,exynos5420-nocp", },
188 { },
189};
190MODULE_DEVICE_TABLE(of, exynos_nocp_id_match);
191
192static struct regmap_config exynos_nocp_regmap_config = {
193 .reg_bits = 32,
194 .val_bits = 32,
195 .reg_stride = 4,
196 .max_register = NOCP_COUNTERS_3_VAL,
197};
198
199static int exynos_nocp_parse_dt(struct platform_device *pdev,
200 struct exynos_nocp *nocp)
201{
202 struct device *dev = nocp->dev;
203 struct device_node *np = dev->of_node;
204 struct resource *res;
205 void __iomem *base;
206
207 if (!np) {
208 dev_err(dev, "failed to find devicetree node\n");
209 return -EINVAL;
210 }
211
212 nocp->clk = devm_clk_get(dev, "nocp");
213 if (IS_ERR(nocp->clk))
214 nocp->clk = NULL;
215
216
217 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
218 base = devm_ioremap_resource(dev, res);
219 if (IS_ERR(base))
220 return PTR_ERR(base);
221
222 exynos_nocp_regmap_config.max_register = resource_size(res) - 4;
223
224 nocp->regmap = devm_regmap_init_mmio(dev, base,
225 &exynos_nocp_regmap_config);
226 if (IS_ERR(nocp->regmap)) {
227 dev_err(dev, "failed to initialize regmap\n");
228 return PTR_ERR(nocp->regmap);
229 }
230
231 return 0;
232}
233
234static int exynos_nocp_probe(struct platform_device *pdev)
235{
236 struct device *dev = &pdev->dev;
237 struct device_node *np = dev->of_node;
238 struct exynos_nocp *nocp;
239 int ret;
240
241 nocp = devm_kzalloc(&pdev->dev, sizeof(*nocp), GFP_KERNEL);
242 if (!nocp)
243 return -ENOMEM;
244
245 nocp->dev = &pdev->dev;
246
247
248 ret = exynos_nocp_parse_dt(pdev, nocp);
249 if (ret < 0) {
250 dev_err(&pdev->dev,
251 "failed to parse devicetree for resource\n");
252 return ret;
253 }
254
255
256 nocp->desc.ops = &exynos_nocp_ops;
257 nocp->desc.driver_data = nocp;
258 nocp->desc.name = np->full_name;
259 nocp->edev = devm_devfreq_event_add_edev(&pdev->dev, &nocp->desc);
260 if (IS_ERR(nocp->edev)) {
261 dev_err(&pdev->dev,
262 "failed to add devfreq-event device\n");
263 return PTR_ERR(nocp->edev);
264 }
265 platform_set_drvdata(pdev, nocp);
266
267 ret = clk_prepare_enable(nocp->clk);
268 if (ret) {
269 dev_err(&pdev->dev, "failed to prepare ppmu clock\n");
270 return ret;
271 }
272
273 pr_info("exynos-nocp: new NoC Probe device registered: %s\n",
274 dev_name(dev));
275
276 return 0;
277}
278
279static int exynos_nocp_remove(struct platform_device *pdev)
280{
281 struct exynos_nocp *nocp = platform_get_drvdata(pdev);
282
283 clk_disable_unprepare(nocp->clk);
284
285 return 0;
286}
287
288static struct platform_driver exynos_nocp_driver = {
289 .probe = exynos_nocp_probe,
290 .remove = exynos_nocp_remove,
291 .driver = {
292 .name = "exynos-nocp",
293 .of_match_table = exynos_nocp_id_match,
294 },
295};
296module_platform_driver(exynos_nocp_driver);
297
298MODULE_DESCRIPTION("Exynos NoC (Network on Chip) Probe driver");
299MODULE_AUTHOR("Chanwoo Choi <cw00.choi@samsung.com>");
300MODULE_LICENSE("GPL");
301
