1
2
3
4
5
6
7
8
9
10
11
12
13#include <linux/clk.h>
14#include <linux/clkdev.h>
15#include <linux/clk-provider.h>
16#include <linux/debugfs.h>
17#include <linux/idr.h>
18#include <linux/io.h>
19#include <linux/ioport.h>
20#include <linux/kernel.h>
21#include <linux/module.h>
22#include <linux/mfd/core.h>
23#include <linux/pm_qos.h>
24#include <linux/pm_runtime.h>
25#include <linux/property.h>
26#include <linux/seq_file.h>
27#include <linux/io-64-nonatomic-lo-hi.h>
28
29#include <linux/dma/idma64.h>
30
31#include "intel-lpss.h"
32
33#define LPSS_DEV_OFFSET 0x000
34#define LPSS_DEV_SIZE 0x200
35#define LPSS_PRIV_OFFSET 0x200
36#define LPSS_PRIV_SIZE 0x100
37#define LPSS_PRIV_REG_COUNT (LPSS_PRIV_SIZE / 4)
38#define LPSS_IDMA64_OFFSET 0x800
39#define LPSS_IDMA64_SIZE 0x800
40
41
42#define LPSS_PRIV_RESETS 0x04
43#define LPSS_PRIV_RESETS_IDMA BIT(2)
44#define LPSS_PRIV_RESETS_FUNC 0x3
45
46#define LPSS_PRIV_ACTIVELTR 0x10
47#define LPSS_PRIV_IDLELTR 0x14
48
49#define LPSS_PRIV_LTR_REQ BIT(15)
50#define LPSS_PRIV_LTR_SCALE_MASK GENMASK(11, 10)
51#define LPSS_PRIV_LTR_SCALE_1US (2 << 10)
52#define LPSS_PRIV_LTR_SCALE_32US (3 << 10)
53#define LPSS_PRIV_LTR_VALUE_MASK GENMASK(9, 0)
54
55#define LPSS_PRIV_SSP_REG 0x20
56#define LPSS_PRIV_SSP_REG_DIS_DMA_FIN BIT(0)
57
58#define LPSS_PRIV_REMAP_ADDR 0x40
59
60#define LPSS_PRIV_CAPS 0xfc
61#define LPSS_PRIV_CAPS_NO_IDMA BIT(8)
62#define LPSS_PRIV_CAPS_TYPE_MASK GENMASK(7, 4)
63#define LPSS_PRIV_CAPS_TYPE_SHIFT 4
64
65
66enum intel_lpss_dev_type {
67 LPSS_DEV_I2C = 0,
68 LPSS_DEV_UART,
69 LPSS_DEV_SPI,
70};
71
72struct intel_lpss {
73 const struct intel_lpss_platform_info *info;
74 enum intel_lpss_dev_type type;
75 struct clk *clk;
76 struct clk_lookup *clock;
77 struct mfd_cell *cell;
78 struct device *dev;
79 void __iomem *priv;
80 u32 priv_ctx[LPSS_PRIV_REG_COUNT];
81 int devid;
82 u32 caps;
83 u32 active_ltr;
84 u32 idle_ltr;
85 struct dentry *debugfs;
86};
87
88static const struct resource intel_lpss_dev_resources[] = {
89 DEFINE_RES_MEM_NAMED(LPSS_DEV_OFFSET, LPSS_DEV_SIZE, "lpss_dev"),
90 DEFINE_RES_MEM_NAMED(LPSS_PRIV_OFFSET, LPSS_PRIV_SIZE, "lpss_priv"),
91 DEFINE_RES_IRQ(0),
92};
93
94static const struct resource intel_lpss_idma64_resources[] = {
95 DEFINE_RES_MEM(LPSS_IDMA64_OFFSET, LPSS_IDMA64_SIZE),
96 DEFINE_RES_IRQ(0),
97};
98
99
100
101
102
103
104static const struct mfd_cell intel_lpss_idma64_cell = {
105 .name = LPSS_IDMA64_DRIVER_NAME,
106 .num_resources = ARRAY_SIZE(intel_lpss_idma64_resources),
107 .resources = intel_lpss_idma64_resources,
108};
109
110static const struct mfd_cell intel_lpss_i2c_cell = {
111 .name = "i2c_designware",
112 .num_resources = ARRAY_SIZE(intel_lpss_dev_resources),
113 .resources = intel_lpss_dev_resources,
114};
115
116static const struct mfd_cell intel_lpss_uart_cell = {
117 .name = "dw-apb-uart",
118 .num_resources = ARRAY_SIZE(intel_lpss_dev_resources),
119 .resources = intel_lpss_dev_resources,
120};
121
122static const struct mfd_cell intel_lpss_spi_cell = {
123 .name = "pxa2xx-spi",
124 .num_resources = ARRAY_SIZE(intel_lpss_dev_resources),
125 .resources = intel_lpss_dev_resources,
126};
127
128static DEFINE_IDA(intel_lpss_devid_ida);
129static struct dentry *intel_lpss_debugfs;
130
131static void intel_lpss_cache_ltr(struct intel_lpss *lpss)
132{
133 lpss->active_ltr = readl(lpss->priv + LPSS_PRIV_ACTIVELTR);
134 lpss->idle_ltr = readl(lpss->priv + LPSS_PRIV_IDLELTR);
135}
136
137static int intel_lpss_debugfs_add(struct intel_lpss *lpss)
138{
139 struct dentry *dir;
140
141 dir = debugfs_create_dir(dev_name(lpss->dev), intel_lpss_debugfs);
142 if (IS_ERR(dir))
143 return PTR_ERR(dir);
144
145
146 intel_lpss_cache_ltr(lpss);
147
148 debugfs_create_x32("capabilities", S_IRUGO, dir, &lpss->caps);
149 debugfs_create_x32("active_ltr", S_IRUGO, dir, &lpss->active_ltr);
150 debugfs_create_x32("idle_ltr", S_IRUGO, dir, &lpss->idle_ltr);
151
152 lpss->debugfs = dir;
153 return 0;
154}
155
156static void intel_lpss_debugfs_remove(struct intel_lpss *lpss)
157{
158 debugfs_remove_recursive(lpss->debugfs);
159}
160
161static void intel_lpss_ltr_set(struct device *dev, s32 val)
162{
163 struct intel_lpss *lpss = dev_get_drvdata(dev);
164 u32 ltr;
165
166
167
168
169
170
171 ltr = readl(lpss->priv + LPSS_PRIV_ACTIVELTR);
172
173 if (val == PM_QOS_LATENCY_ANY || val < 0) {
174 ltr &= ~LPSS_PRIV_LTR_REQ;
175 } else {
176 ltr |= LPSS_PRIV_LTR_REQ;
177 ltr &= ~LPSS_PRIV_LTR_SCALE_MASK;
178 ltr &= ~LPSS_PRIV_LTR_VALUE_MASK;
179
180 if (val > LPSS_PRIV_LTR_VALUE_MASK)
181 ltr |= LPSS_PRIV_LTR_SCALE_32US | val >> 5;
182 else
183 ltr |= LPSS_PRIV_LTR_SCALE_1US | val;
184 }
185
186 if (ltr == lpss->active_ltr)
187 return;
188
189 writel(ltr, lpss->priv + LPSS_PRIV_ACTIVELTR);
190 writel(ltr, lpss->priv + LPSS_PRIV_IDLELTR);
191
192
193 intel_lpss_cache_ltr(lpss);
194}
195
196static void intel_lpss_ltr_expose(struct intel_lpss *lpss)
197{
198 lpss->dev->power.set_latency_tolerance = intel_lpss_ltr_set;
199 dev_pm_qos_expose_latency_tolerance(lpss->dev);
200}
201
202static void intel_lpss_ltr_hide(struct intel_lpss *lpss)
203{
204 dev_pm_qos_hide_latency_tolerance(lpss->dev);
205 lpss->dev->power.set_latency_tolerance = NULL;
206}
207
208static int intel_lpss_assign_devs(struct intel_lpss *lpss)
209{
210 const struct mfd_cell *cell;
211 unsigned int type;
212
213 type = lpss->caps & LPSS_PRIV_CAPS_TYPE_MASK;
214 type >>= LPSS_PRIV_CAPS_TYPE_SHIFT;
215
216 switch (type) {
217 case LPSS_DEV_I2C:
218 cell = &intel_lpss_i2c_cell;
219 break;
220 case LPSS_DEV_UART:
221 cell = &intel_lpss_uart_cell;
222 break;
223 case LPSS_DEV_SPI:
224 cell = &intel_lpss_spi_cell;
225 break;
226 default:
227 return -ENODEV;
228 }
229
230 lpss->cell = devm_kmemdup(lpss->dev, cell, sizeof(*cell), GFP_KERNEL);
231 if (!lpss->cell)
232 return -ENOMEM;
233
234 lpss->type = type;
235
236 return 0;
237}
238
239static bool intel_lpss_has_idma(const struct intel_lpss *lpss)
240{
241 return (lpss->caps & LPSS_PRIV_CAPS_NO_IDMA) == 0;
242}
243
244static void intel_lpss_set_remap_addr(const struct intel_lpss *lpss)
245{
246 resource_size_t addr = lpss->info->mem->start;
247
248 lo_hi_writeq(addr, lpss->priv + LPSS_PRIV_REMAP_ADDR);
249}
250
251static void intel_lpss_deassert_reset(const struct intel_lpss *lpss)
252{
253 u32 value = LPSS_PRIV_RESETS_FUNC | LPSS_PRIV_RESETS_IDMA;
254
255
256 writel(value, lpss->priv + LPSS_PRIV_RESETS);
257}
258
259static void intel_lpss_init_dev(const struct intel_lpss *lpss)
260{
261 u32 value = LPSS_PRIV_SSP_REG_DIS_DMA_FIN;
262
263
264 writel(0, lpss->priv + LPSS_PRIV_RESETS);
265
266 intel_lpss_deassert_reset(lpss);
267
268 intel_lpss_set_remap_addr(lpss);
269
270 if (!intel_lpss_has_idma(lpss))
271 return;
272
273
274 if (lpss->type == LPSS_DEV_SPI)
275 writel(value, lpss->priv + LPSS_PRIV_SSP_REG);
276}
277
278static void intel_lpss_unregister_clock_tree(struct clk *clk)
279{
280 struct clk *parent;
281
282 while (clk) {
283 parent = clk_get_parent(clk);
284 clk_unregister(clk);
285 clk = parent;
286 }
287}
288
289static int intel_lpss_register_clock_divider(struct intel_lpss *lpss,
290 const char *devname,
291 struct clk **clk)
292{
293 char name[32];
294 struct clk *tmp = *clk;
295
296 snprintf(name, sizeof(name), "%s-enable", devname);
297 tmp = clk_register_gate(NULL, name, __clk_get_name(tmp), 0,
298 lpss->priv, 0, 0, NULL);
299 if (IS_ERR(tmp))
300 return PTR_ERR(tmp);
301
302 snprintf(name, sizeof(name), "%s-div", devname);
303 tmp = clk_register_fractional_divider(NULL, name, __clk_get_name(tmp),
304 0, lpss->priv, 1, 15, 16, 15, 0,
305 NULL);
306 if (IS_ERR(tmp))
307 return PTR_ERR(tmp);
308 *clk = tmp;
309
310 snprintf(name, sizeof(name), "%s-update", devname);
311 tmp = clk_register_gate(NULL, name, __clk_get_name(tmp),
312 CLK_SET_RATE_PARENT, lpss->priv, 31, 0, NULL);
313 if (IS_ERR(tmp))
314 return PTR_ERR(tmp);
315 *clk = tmp;
316
317 return 0;
318}
319
320static int intel_lpss_register_clock(struct intel_lpss *lpss)
321{
322 const struct mfd_cell *cell = lpss->cell;
323 struct clk *clk;
324 char devname[24];
325 int ret;
326
327 if (!lpss->info->clk_rate)
328 return 0;
329
330
331 clk = clk_register_fixed_rate(NULL, dev_name(lpss->dev), NULL, 0,
332 lpss->info->clk_rate);
333 if (IS_ERR(clk))
334 return PTR_ERR(clk);
335
336 snprintf(devname, sizeof(devname), "%s.%d", cell->name, lpss->devid);
337
338
339
340
341
342 if (lpss->type != LPSS_DEV_I2C) {
343 ret = intel_lpss_register_clock_divider(lpss, devname, &clk);
344 if (ret)
345 goto err_clk_register;
346 }
347
348 ret = -ENOMEM;
349
350
351 lpss->clock = clkdev_create(clk, lpss->info->clk_con_id, "%s", devname);
352 if (!lpss->clock)
353 goto err_clk_register;
354
355 lpss->clk = clk;
356
357 return 0;
358
359err_clk_register:
360 intel_lpss_unregister_clock_tree(clk);
361
362 return ret;
363}
364
365static void intel_lpss_unregister_clock(struct intel_lpss *lpss)
366{
367 if (IS_ERR_OR_NULL(lpss->clk))
368 return;
369
370 clkdev_drop(lpss->clock);
371 intel_lpss_unregister_clock_tree(lpss->clk);
372}
373
374int intel_lpss_probe(struct device *dev,
375 const struct intel_lpss_platform_info *info)
376{
377 struct intel_lpss *lpss;
378 int ret;
379
380 if (!info || !info->mem || info->irq <= 0)
381 return -EINVAL;
382
383 lpss = devm_kzalloc(dev, sizeof(*lpss), GFP_KERNEL);
384 if (!lpss)
385 return -ENOMEM;
386
387 lpss->priv = devm_ioremap_uc(dev, info->mem->start + LPSS_PRIV_OFFSET,
388 LPSS_PRIV_SIZE);
389 if (!lpss->priv)
390 return -ENOMEM;
391
392 lpss->info = info;
393 lpss->dev = dev;
394 lpss->caps = readl(lpss->priv + LPSS_PRIV_CAPS);
395
396 dev_set_drvdata(dev, lpss);
397
398 ret = intel_lpss_assign_devs(lpss);
399 if (ret)
400 return ret;
401
402 lpss->cell->swnode = info->swnode;
403
404 intel_lpss_init_dev(lpss);
405
406 lpss->devid = ida_simple_get(&intel_lpss_devid_ida, 0, 0, GFP_KERNEL);
407 if (lpss->devid < 0)
408 return lpss->devid;
409
410 ret = intel_lpss_register_clock(lpss);
411 if (ret)
412 goto err_clk_register;
413
414 intel_lpss_ltr_expose(lpss);
415
416 ret = intel_lpss_debugfs_add(lpss);
417 if (ret)
418 dev_warn(dev, "Failed to create debugfs entries\n");
419
420 if (intel_lpss_has_idma(lpss)) {
421 ret = mfd_add_devices(dev, lpss->devid, &intel_lpss_idma64_cell,
422 1, info->mem, info->irq, NULL);
423 if (ret)
424 dev_warn(dev, "Failed to add %s, fallback to PIO\n",
425 LPSS_IDMA64_DRIVER_NAME);
426 }
427
428 ret = mfd_add_devices(dev, lpss->devid, lpss->cell,
429 1, info->mem, info->irq, NULL);
430 if (ret)
431 goto err_remove_ltr;
432
433 dev_pm_set_driver_flags(dev, DPM_FLAG_SMART_SUSPEND);
434
435 return 0;
436
437err_remove_ltr:
438 intel_lpss_debugfs_remove(lpss);
439 intel_lpss_ltr_hide(lpss);
440 intel_lpss_unregister_clock(lpss);
441
442err_clk_register:
443 ida_simple_remove(&intel_lpss_devid_ida, lpss->devid);
444
445 return ret;
446}
447EXPORT_SYMBOL_GPL(intel_lpss_probe);
448
449void intel_lpss_remove(struct device *dev)
450{
451 struct intel_lpss *lpss = dev_get_drvdata(dev);
452
453 mfd_remove_devices(dev);
454 intel_lpss_debugfs_remove(lpss);
455 intel_lpss_ltr_hide(lpss);
456 intel_lpss_unregister_clock(lpss);
457 ida_simple_remove(&intel_lpss_devid_ida, lpss->devid);
458}
459EXPORT_SYMBOL_GPL(intel_lpss_remove);
460
461static int resume_lpss_device(struct device *dev, void *data)
462{
463 if (!dev_pm_test_driver_flags(dev, DPM_FLAG_SMART_SUSPEND))
464 pm_runtime_resume(dev);
465
466 return 0;
467}
468
469int intel_lpss_prepare(struct device *dev)
470{
471
472
473
474
475 device_for_each_child_reverse(dev, NULL, resume_lpss_device);
476 return 0;
477}
478EXPORT_SYMBOL_GPL(intel_lpss_prepare);
479
480int intel_lpss_suspend(struct device *dev)
481{
482 struct intel_lpss *lpss = dev_get_drvdata(dev);
483 unsigned int i;
484
485
486 for (i = 0; i < LPSS_PRIV_REG_COUNT; i++)
487 lpss->priv_ctx[i] = readl(lpss->priv + i * 4);
488
489
490
491
492
493
494 if (lpss->type != LPSS_DEV_UART)
495 writel(0, lpss->priv + LPSS_PRIV_RESETS);
496
497 return 0;
498}
499EXPORT_SYMBOL_GPL(intel_lpss_suspend);
500
501int intel_lpss_resume(struct device *dev)
502{
503 struct intel_lpss *lpss = dev_get_drvdata(dev);
504 unsigned int i;
505
506 intel_lpss_deassert_reset(lpss);
507
508
509 for (i = 0; i < LPSS_PRIV_REG_COUNT; i++)
510 writel(lpss->priv_ctx[i], lpss->priv + i * 4);
511
512 return 0;
513}
514EXPORT_SYMBOL_GPL(intel_lpss_resume);
515
516static int __init intel_lpss_init(void)
517{
518 intel_lpss_debugfs = debugfs_create_dir("intel_lpss", NULL);
519 return 0;
520}
521module_init(intel_lpss_init);
522
523static void __exit intel_lpss_exit(void)
524{
525 ida_destroy(&intel_lpss_devid_ida);
526 debugfs_remove(intel_lpss_debugfs);
527}
528module_exit(intel_lpss_exit);
529
530MODULE_AUTHOR("Andy Shevchenko <andriy.shevchenko@linux.intel.com>");
531MODULE_AUTHOR("Mika Westerberg <mika.westerberg@linux.intel.com>");
532MODULE_AUTHOR("Heikki Krogerus <heikki.krogerus@linux.intel.com>");
533MODULE_AUTHOR("Jarkko Nikula <jarkko.nikula@linux.intel.com>");
534MODULE_DESCRIPTION("Intel LPSS core driver");
535MODULE_LICENSE("GPL v2");
536
537
538
539
540
541
542
543MODULE_SOFTDEP("pre: platform:" LPSS_IDMA64_DRIVER_NAME);
544