aboutsummaryrefslogtreecommitdiffstats
path: root/arch/arm/mach-omap2/omap_device.c
diff options
context:
space:
mode:
authorTony Lindgren <tony@atomide.com>2012-10-02 20:25:48 -0400
committerTony Lindgren <tony@atomide.com>2012-10-17 15:08:40 -0400
commit25c7d49ed48b4843da7dea56a81ae7f620211ee0 (patch)
tree88451639ae0e2d74bbac1a31314a8a274d68e629 /arch/arm/mach-omap2/omap_device.c
parent622297fdec22310d57cc3222a8fc337993c7cd23 (diff)
ARM: OMAP: Make omap_device local to mach-omap2
Let's make omap_device local to mach-omap2 for ARM common zImage support. Signed-off-by: Tony Lindgren <tony@atomide.com>
Diffstat (limited to 'arch/arm/mach-omap2/omap_device.c')
-rw-r--r--arch/arm/mach-omap2/omap_device.c1278
1 files changed, 1278 insertions, 0 deletions
diff --git a/arch/arm/mach-omap2/omap_device.c b/arch/arm/mach-omap2/omap_device.c
new file mode 100644
index 000000000000..e5fbcb53c7cc
--- /dev/null
+++ b/arch/arm/mach-omap2/omap_device.c
@@ -0,0 +1,1278 @@
1/*
2 * omap_device implementation
3 *
4 * Copyright (C) 2009-2010 Nokia Corporation
5 * Paul Walmsley, Kevin Hilman
6 *
7 * Developed in collaboration with (alphabetical order): Benoit
8 * Cousson, Thara Gopinath, Tony Lindgren, Rajendra Nayak, Vikram
9 * Pandita, Sakari Poussa, Anand Sawant, Santosh Shilimkar, Richard
10 * Woodruff
11 *
12 * This program is free software; you can redistribute it and/or modify
13 * it under the terms of the GNU General Public License version 2 as
14 * published by the Free Software Foundation.
15 *
16 * This code provides a consistent interface for OMAP device drivers
17 * to control power management and interconnect properties of their
18 * devices.
19 *
20 * In the medium- to long-term, this code should either be
21 * a) implemented via arch-specific pointers in platform_data
22 * or
23 * b) implemented as a proper omap_bus/omap_device in Linux, no more
24 * platform_data func pointers
25 *
26 *
27 * Guidelines for usage by driver authors:
28 *
29 * 1. These functions are intended to be used by device drivers via
30 * function pointers in struct platform_data. As an example,
31 * omap_device_enable() should be passed to the driver as
32 *
33 * struct foo_driver_platform_data {
34 * ...
35 * int (*device_enable)(struct platform_device *pdev);
36 * ...
37 * }
38 *
39 * Note that the generic "device_enable" name is used, rather than
40 * "omap_device_enable". This is so other architectures can pass in their
41 * own enable/disable functions here.
42 *
43 * This should be populated during device setup:
44 *
45 * ...
46 * pdata->device_enable = omap_device_enable;
47 * ...
48 *
49 * 2. Drivers should first check to ensure the function pointer is not null
50 * before calling it, as in:
51 *
52 * if (pdata->device_enable)
53 * pdata->device_enable(pdev);
54 *
55 * This allows other architectures that don't use similar device_enable()/
56 * device_shutdown() functions to execute normally.
57 *
58 * ...
59 *
60 * Suggested usage by device drivers:
61 *
62 * During device initialization:
63 * device_enable()
64 *
65 * During device idle:
66 * (save remaining device context if necessary)
67 * device_idle();
68 *
69 * During device resume:
70 * device_enable();
71 * (restore context if necessary)
72 *
73 * During device shutdown:
74 * device_shutdown()
75 * (device must be reinitialized at this point to use it again)
76 *
77 */
78#undef DEBUG
79
80#include <linux/kernel.h>
81#include <linux/export.h>
82#include <linux/platform_device.h>
83#include <linux/slab.h>
84#include <linux/err.h>
85#include <linux/io.h>
86#include <linux/clk.h>
87#include <linux/clkdev.h>
88#include <linux/pm_runtime.h>
89#include <linux/of.h>
90#include <linux/notifier.h>
91
92#include "omap_device.h"
93#include <plat/omap_hwmod.h>
94#include <plat/clock.h>
95
96/* These parameters are passed to _omap_device_{de,}activate() */
97#define USE_WAKEUP_LAT 0
98#define IGNORE_WAKEUP_LAT 1
99
100static int omap_early_device_register(struct platform_device *pdev);
101
102static struct omap_device_pm_latency omap_default_latency[] = {
103 {
104 .deactivate_func = omap_device_idle_hwmods,
105 .activate_func = omap_device_enable_hwmods,
106 .flags = OMAP_DEVICE_LATENCY_AUTO_ADJUST,
107 }
108};
109
110/* Private functions */
111
112/**
113 * _omap_device_activate - increase device readiness
114 * @od: struct omap_device *
115 * @ignore_lat: increase to latency target (0) or full readiness (1)?
116 *
117 * Increase readiness of omap_device @od (thus decreasing device
118 * wakeup latency, but consuming more power). If @ignore_lat is
119 * IGNORE_WAKEUP_LAT, make the omap_device fully active. Otherwise,
120 * if @ignore_lat is USE_WAKEUP_LAT, and the device's maximum wakeup
121 * latency is greater than the requested maximum wakeup latency, step
122 * backwards in the omap_device_pm_latency table to ensure the
123 * device's maximum wakeup latency is less than or equal to the
124 * requested maximum wakeup latency. Returns 0.
125 */
126static int _omap_device_activate(struct omap_device *od, u8 ignore_lat)
127{
128 struct timespec a, b, c;
129
130 dev_dbg(&od->pdev->dev, "omap_device: activating\n");
131
132 while (od->pm_lat_level > 0) {
133 struct omap_device_pm_latency *odpl;
134 unsigned long long act_lat = 0;
135
136 od->pm_lat_level--;
137
138 odpl = od->pm_lats + od->pm_lat_level;
139
140 if (!ignore_lat &&
141 (od->dev_wakeup_lat <= od->_dev_wakeup_lat_limit))
142 break;
143
144 read_persistent_clock(&a);
145
146 /* XXX check return code */
147 odpl->activate_func(od);
148
149 read_persistent_clock(&b);
150
151 c = timespec_sub(b, a);
152 act_lat = timespec_to_ns(&c);
153
154 dev_dbg(&od->pdev->dev,
155 "omap_device: pm_lat %d: activate: elapsed time %llu nsec\n",
156 od->pm_lat_level, act_lat);
157
158 if (act_lat > odpl->activate_lat) {
159 odpl->activate_lat_worst = act_lat;
160 if (odpl->flags & OMAP_DEVICE_LATENCY_AUTO_ADJUST) {
161 odpl->activate_lat = act_lat;
162 dev_dbg(&od->pdev->dev,
163 "new worst case activate latency %d: %llu\n",
164 od->pm_lat_level, act_lat);
165 } else
166 dev_warn(&od->pdev->dev,
167 "activate latency %d higher than expected. (%llu > %d)\n",
168 od->pm_lat_level, act_lat,
169 odpl->activate_lat);
170 }
171
172 od->dev_wakeup_lat -= odpl->activate_lat;
173 }
174
175 return 0;
176}
177
178/**
179 * _omap_device_deactivate - decrease device readiness
180 * @od: struct omap_device *
181 * @ignore_lat: decrease to latency target (0) or full inactivity (1)?
182 *
183 * Decrease readiness of omap_device @od (thus increasing device
184 * wakeup latency, but conserving power). If @ignore_lat is
185 * IGNORE_WAKEUP_LAT, make the omap_device fully inactive. Otherwise,
186 * if @ignore_lat is USE_WAKEUP_LAT, and the device's maximum wakeup
187 * latency is less than the requested maximum wakeup latency, step
188 * forwards in the omap_device_pm_latency table to ensure the device's
189 * maximum wakeup latency is less than or equal to the requested
190 * maximum wakeup latency. Returns 0.
191 */
192static int _omap_device_deactivate(struct omap_device *od, u8 ignore_lat)
193{
194 struct timespec a, b, c;
195
196 dev_dbg(&od->pdev->dev, "omap_device: deactivating\n");
197
198 while (od->pm_lat_level < od->pm_lats_cnt) {
199 struct omap_device_pm_latency *odpl;
200 unsigned long long deact_lat = 0;
201
202 odpl = od->pm_lats + od->pm_lat_level;
203
204 if (!ignore_lat &&
205 ((od->dev_wakeup_lat + odpl->activate_lat) >
206 od->_dev_wakeup_lat_limit))
207 break;
208
209 read_persistent_clock(&a);
210
211 /* XXX check return code */
212 odpl->deactivate_func(od);
213
214 read_persistent_clock(&b);
215
216 c = timespec_sub(b, a);
217 deact_lat = timespec_to_ns(&c);
218
219 dev_dbg(&od->pdev->dev,
220 "omap_device: pm_lat %d: deactivate: elapsed time %llu nsec\n",
221 od->pm_lat_level, deact_lat);
222
223 if (deact_lat > odpl->deactivate_lat) {
224 odpl->deactivate_lat_worst = deact_lat;
225 if (odpl->flags & OMAP_DEVICE_LATENCY_AUTO_ADJUST) {
226 odpl->deactivate_lat = deact_lat;
227 dev_dbg(&od->pdev->dev,
228 "new worst case deactivate latency %d: %llu\n",
229 od->pm_lat_level, deact_lat);
230 } else
231 dev_warn(&od->pdev->dev,
232 "deactivate latency %d higher than expected. (%llu > %d)\n",
233 od->pm_lat_level, deact_lat,
234 odpl->deactivate_lat);
235 }
236
237 od->dev_wakeup_lat += odpl->activate_lat;
238
239 od->pm_lat_level++;
240 }
241
242 return 0;
243}
244
245static void _add_clkdev(struct omap_device *od, const char *clk_alias,
246 const char *clk_name)
247{
248 struct clk *r;
249 struct clk_lookup *l;
250
251 if (!clk_alias || !clk_name)
252 return;
253
254 dev_dbg(&od->pdev->dev, "Creating %s -> %s\n", clk_alias, clk_name);
255
256 r = clk_get_sys(dev_name(&od->pdev->dev), clk_alias);
257 if (!IS_ERR(r)) {
258 dev_warn(&od->pdev->dev,
259 "alias %s already exists\n", clk_alias);
260 clk_put(r);
261 return;
262 }
263
264 r = clk_get(NULL, clk_name);
265 if (IS_ERR(r)) {
266 dev_err(&od->pdev->dev,
267 "clk_get for %s failed\n", clk_name);
268 return;
269 }
270
271 l = clkdev_alloc(r, clk_alias, dev_name(&od->pdev->dev));
272 if (!l) {
273 dev_err(&od->pdev->dev,
274 "clkdev_alloc for %s failed\n", clk_alias);
275 return;
276 }
277
278 clkdev_add(l);
279}
280
281/**
282 * _add_hwmod_clocks_clkdev - Add clkdev entry for hwmod optional clocks
283 * and main clock
284 * @od: struct omap_device *od
285 * @oh: struct omap_hwmod *oh
286 *
287 * For the main clock and every optional clock present per hwmod per
288 * omap_device, this function adds an entry in the clkdev table of the
289 * form <dev-id=dev_name, con-id=role> if it does not exist already.
290 *
291 * The function is called from inside omap_device_build_ss(), after
292 * omap_device_register.
293 *
294 * This allows drivers to get a pointer to its optional clocks based on its role
295 * by calling clk_get(<dev*>, <role>).
296 * In the case of the main clock, a "fck" alias is used.
297 *
298 * No return value.
299 */
300static void _add_hwmod_clocks_clkdev(struct omap_device *od,
301 struct omap_hwmod *oh)
302{
303 int i;
304
305 _add_clkdev(od, "fck", oh->main_clk);
306
307 for (i = 0; i < oh->opt_clks_cnt; i++)
308 _add_clkdev(od, oh->opt_clks[i].role, oh->opt_clks[i].clk);
309}
310
311
312/**
313 * omap_device_build_from_dt - build an omap_device with multiple hwmods
314 * @pdev_name: name of the platform_device driver to use
315 * @pdev_id: this platform_device's connection ID
316 * @oh: ptr to the single omap_hwmod that backs this omap_device
317 * @pdata: platform_data ptr to associate with the platform_device
318 * @pdata_len: amount of memory pointed to by @pdata
319 * @pm_lats: pointer to a omap_device_pm_latency array for this device
320 * @pm_lats_cnt: ARRAY_SIZE() of @pm_lats
321 * @is_early_device: should the device be registered as an early device or not
322 *
323 * Function for building an omap_device already registered from device-tree
324 *
325 * Returns 0 or PTR_ERR() on error.
326 */
327static int omap_device_build_from_dt(struct platform_device *pdev)
328{
329 struct omap_hwmod **hwmods;
330 struct omap_device *od;
331 struct omap_hwmod *oh;
332 struct device_node *node = pdev->dev.of_node;
333 const char *oh_name;
334 int oh_cnt, i, ret = 0;
335
336 oh_cnt = of_property_count_strings(node, "ti,hwmods");
337 if (!oh_cnt || IS_ERR_VALUE(oh_cnt)) {
338 dev_dbg(&pdev->dev, "No 'hwmods' to build omap_device\n");
339 return -ENODEV;
340 }
341
342 hwmods = kzalloc(sizeof(struct omap_hwmod *) * oh_cnt, GFP_KERNEL);
343 if (!hwmods) {
344 ret = -ENOMEM;
345 goto odbfd_exit;
346 }
347
348 for (i = 0; i < oh_cnt; i++) {
349 of_property_read_string_index(node, "ti,hwmods", i, &oh_name);
350 oh = omap_hwmod_lookup(oh_name);
351 if (!oh) {
352 dev_err(&pdev->dev, "Cannot lookup hwmod '%s'\n",
353 oh_name);
354 ret = -EINVAL;
355 goto odbfd_exit1;
356 }
357 hwmods[i] = oh;
358 }
359
360 od = omap_device_alloc(pdev, hwmods, oh_cnt, NULL, 0);
361 if (!od) {
362 dev_err(&pdev->dev, "Cannot allocate omap_device for :%s\n",
363 oh_name);
364 ret = PTR_ERR(od);
365 goto odbfd_exit1;
366 }
367
368 /* Fix up missing resource names */
369 for (i = 0; i < pdev->num_resources; i++) {
370 struct resource *r = &pdev->resource[i];
371
372 if (r->name == NULL)
373 r->name = dev_name(&pdev->dev);
374 }
375
376 if (of_get_property(node, "ti,no_idle_on_suspend", NULL))
377 omap_device_disable_idle_on_suspend(pdev);
378
379 pdev->dev.pm_domain = &omap_device_pm_domain;
380
381odbfd_exit1:
382 kfree(hwmods);
383odbfd_exit:
384 return ret;
385}
386
387static int _omap_device_notifier_call(struct notifier_block *nb,
388 unsigned long event, void *dev)
389{
390 struct platform_device *pdev = to_platform_device(dev);
391 struct omap_device *od;
392
393 switch (event) {
394 case BUS_NOTIFY_DEL_DEVICE:
395 if (pdev->archdata.od)
396 omap_device_delete(pdev->archdata.od);
397 break;
398 case BUS_NOTIFY_ADD_DEVICE:
399 if (pdev->dev.of_node)
400 omap_device_build_from_dt(pdev);
401 /* fall through */
402 default:
403 od = to_omap_device(pdev);
404 if (od)
405 od->_driver_status = event;
406 }
407
408 return NOTIFY_DONE;
409}
410
411
412/* Public functions for use by core code */
413
414/**
415 * omap_device_get_context_loss_count - get lost context count
416 * @od: struct omap_device *
417 *
418 * Using the primary hwmod, query the context loss count for this
419 * device.
420 *
421 * Callers should consider context for this device lost any time this
422 * function returns a value different than the value the caller got
423 * the last time it called this function.
424 *
425 * If any hwmods exist for the omap_device assoiated with @pdev,
426 * return the context loss counter for that hwmod, otherwise return
427 * zero.
428 */
429int omap_device_get_context_loss_count(struct platform_device *pdev)
430{
431 struct omap_device *od;
432 u32 ret = 0;
433
434 od = to_omap_device(pdev);
435
436 if (od->hwmods_cnt)
437 ret = omap_hwmod_get_context_loss_count(od->hwmods[0]);
438
439 return ret;
440}
441
442/**
443 * omap_device_count_resources - count number of struct resource entries needed
444 * @od: struct omap_device *
445 *
446 * Count the number of struct resource entries needed for this
447 * omap_device @od. Used by omap_device_build_ss() to determine how
448 * much memory to allocate before calling
449 * omap_device_fill_resources(). Returns the count.
450 */
451static int omap_device_count_resources(struct omap_device *od)
452{
453 int c = 0;
454 int i;
455
456 for (i = 0; i < od->hwmods_cnt; i++)
457 c += omap_hwmod_count_resources(od->hwmods[i]);
458
459 pr_debug("omap_device: %s: counted %d total resources across %d hwmods\n",
460 od->pdev->name, c, od->hwmods_cnt);
461
462 return c;
463}
464
465/**
466 * omap_device_fill_resources - fill in array of struct resource
467 * @od: struct omap_device *
468 * @res: pointer to an array of struct resource to be filled in
469 *
470 * Populate one or more empty struct resource pointed to by @res with
471 * the resource data for this omap_device @od. Used by
472 * omap_device_build_ss() after calling omap_device_count_resources().
473 * Ideally this function would not be needed at all. If omap_device
474 * replaces platform_device, then we can specify our own
475 * get_resource()/ get_irq()/etc functions that use the underlying
476 * omap_hwmod information. Or if platform_device is extended to use
477 * subarchitecture-specific function pointers, the various
478 * platform_device functions can simply call omap_device internal
479 * functions to get device resources. Hacking around the existing
480 * platform_device code wastes memory. Returns 0.
481 */
482static int omap_device_fill_resources(struct omap_device *od,
483 struct resource *res)
484{
485 int i, r;
486
487 for (i = 0; i < od->hwmods_cnt; i++) {
488 r = omap_hwmod_fill_resources(od->hwmods[i], res);
489 res += r;
490 }
491
492 return 0;
493}
494
495/**
496 * _od_fill_dma_resources - fill in array of struct resource with dma resources
497 * @od: struct omap_device *
498 * @res: pointer to an array of struct resource to be filled in
499 *
500 * Populate one or more empty struct resource pointed to by @res with
501 * the dma resource data for this omap_device @od. Used by
502 * omap_device_alloc() after calling omap_device_count_resources().
503 *
504 * Ideally this function would not be needed at all. If we have
505 * mechanism to get dma resources from DT.
506 *
507 * Returns 0.
508 */
509static int _od_fill_dma_resources(struct omap_device *od,
510 struct resource *res)
511{
512 int i, r;
513
514 for (i = 0; i < od->hwmods_cnt; i++) {
515 r = omap_hwmod_fill_dma_resources(od->hwmods[i], res);
516 res += r;
517 }
518
519 return 0;
520}
521
522/**
523 * omap_device_alloc - allocate an omap_device
524 * @pdev: platform_device that will be included in this omap_device
525 * @oh: ptr to the single omap_hwmod that backs this omap_device
526 * @pdata: platform_data ptr to associate with the platform_device
527 * @pdata_len: amount of memory pointed to by @pdata
528 * @pm_lats: pointer to a omap_device_pm_latency array for this device
529 * @pm_lats_cnt: ARRAY_SIZE() of @pm_lats
530 *
531 * Convenience function for allocating an omap_device structure and filling
532 * hwmods, resources and pm_latency attributes.
533 *
534 * Returns an struct omap_device pointer or ERR_PTR() on error;
535 */
536struct omap_device *omap_device_alloc(struct platform_device *pdev,
537 struct omap_hwmod **ohs, int oh_cnt,
538 struct omap_device_pm_latency *pm_lats,
539 int pm_lats_cnt)
540{
541 int ret = -ENOMEM;
542 struct omap_device *od;
543 struct resource *res = NULL;
544 int i, res_count;
545 struct omap_hwmod **hwmods;
546
547 od = kzalloc(sizeof(struct omap_device), GFP_KERNEL);
548 if (!od) {
549 ret = -ENOMEM;
550 goto oda_exit1;
551 }
552 od->hwmods_cnt = oh_cnt;
553
554 hwmods = kmemdup(ohs, sizeof(struct omap_hwmod *) * oh_cnt, GFP_KERNEL);
555 if (!hwmods)
556 goto oda_exit2;
557
558 od->hwmods = hwmods;
559 od->pdev = pdev;
560
561 res_count = omap_device_count_resources(od);
562 /*
563 * DT Boot:
564 * OF framework will construct the resource structure (currently
565 * does for MEM & IRQ resource) and we should respect/use these
566 * resources, killing hwmod dependency.
567 * If pdev->num_resources > 0, we assume that MEM & IRQ resources
568 * have been allocated by OF layer already (through DTB).
569 *
570 * Non-DT Boot:
571 * Here, pdev->num_resources = 0, and we should get all the
572 * resources from hwmod.
573 *
574 * TODO: Once DMA resource is available from OF layer, we should
575 * kill filling any resources from hwmod.
576 */
577 if (res_count > pdev->num_resources) {
578 /* Allocate resources memory to account for new resources */
579 res = kzalloc(sizeof(struct resource) * res_count, GFP_KERNEL);
580 if (!res)
581 goto oda_exit3;
582
583 /*
584 * If pdev->num_resources > 0, then assume that,
585 * MEM and IRQ resources will only come from DT and only
586 * fill DMA resource from hwmod layer.
587 */
588 if (pdev->num_resources && pdev->resource) {
589 dev_dbg(&pdev->dev, "%s(): resources already allocated %d\n",
590 __func__, res_count);
591 memcpy(res, pdev->resource,
592 sizeof(struct resource) * pdev->num_resources);
593 _od_fill_dma_resources(od, &res[pdev->num_resources]);
594 } else {
595 dev_dbg(&pdev->dev, "%s(): using resources from hwmod %d\n",
596 __func__, res_count);
597 omap_device_fill_resources(od, res);
598 }
599
600 ret = platform_device_add_resources(pdev, res, res_count);
601 kfree(res);
602
603 if (ret)
604 goto oda_exit3;
605 }
606
607 if (!pm_lats) {
608 pm_lats = omap_default_latency;
609 pm_lats_cnt = ARRAY_SIZE(omap_default_latency);
610 }
611
612 od->pm_lats_cnt = pm_lats_cnt;
613 od->pm_lats = kmemdup(pm_lats,
614 sizeof(struct omap_device_pm_latency) * pm_lats_cnt,
615 GFP_KERNEL);
616 if (!od->pm_lats)
617 goto oda_exit3;
618
619 pdev->archdata.od = od;
620
621 for (i = 0; i < oh_cnt; i++) {
622 hwmods[i]->od = od;
623 _add_hwmod_clocks_clkdev(od, hwmods[i]);
624 }
625
626 return od;
627
628oda_exit3:
629 kfree(hwmods);
630oda_exit2:
631 kfree(od);
632oda_exit1:
633 dev_err(&pdev->dev, "omap_device: build failed (%d)\n", ret);
634
635 return ERR_PTR(ret);
636}
637
638void omap_device_delete(struct omap_device *od)
639{
640 if (!od)
641 return;
642
643 od->pdev->archdata.od = NULL;
644 kfree(od->pm_lats);
645 kfree(od->hwmods);
646 kfree(od);
647}
648
649/**
650 * omap_device_build - build and register an omap_device with one omap_hwmod
651 * @pdev_name: name of the platform_device driver to use
652 * @pdev_id: this platform_device's connection ID
653 * @oh: ptr to the single omap_hwmod that backs this omap_device
654 * @pdata: platform_data ptr to associate with the platform_device
655 * @pdata_len: amount of memory pointed to by @pdata
656 * @pm_lats: pointer to a omap_device_pm_latency array for this device
657 * @pm_lats_cnt: ARRAY_SIZE() of @pm_lats
658 * @is_early_device: should the device be registered as an early device or not
659 *
660 * Convenience function for building and registering a single
661 * omap_device record, which in turn builds and registers a
662 * platform_device record. See omap_device_build_ss() for more
663 * information. Returns ERR_PTR(-EINVAL) if @oh is NULL; otherwise,
664 * passes along the return value of omap_device_build_ss().
665 */
666struct platform_device __init *omap_device_build(const char *pdev_name, int pdev_id,
667 struct omap_hwmod *oh, void *pdata,
668 int pdata_len,
669 struct omap_device_pm_latency *pm_lats,
670 int pm_lats_cnt, int is_early_device)
671{
672 struct omap_hwmod *ohs[] = { oh };
673
674 if (!oh)
675 return ERR_PTR(-EINVAL);
676
677 return omap_device_build_ss(pdev_name, pdev_id, ohs, 1, pdata,
678 pdata_len, pm_lats, pm_lats_cnt,
679 is_early_device);
680}
681
682/**
683 * omap_device_build_ss - build and register an omap_device with multiple hwmods
684 * @pdev_name: name of the platform_device driver to use
685 * @pdev_id: this platform_device's connection ID
686 * @oh: ptr to the single omap_hwmod that backs this omap_device
687 * @pdata: platform_data ptr to associate with the platform_device
688 * @pdata_len: amount of memory pointed to by @pdata
689 * @pm_lats: pointer to a omap_device_pm_latency array for this device
690 * @pm_lats_cnt: ARRAY_SIZE() of @pm_lats
691 * @is_early_device: should the device be registered as an early device or not
692 *
693 * Convenience function for building and registering an omap_device
694 * subsystem record. Subsystem records consist of multiple
695 * omap_hwmods. This function in turn builds and registers a
696 * platform_device record. Returns an ERR_PTR() on error, or passes
697 * along the return value of omap_device_register().
698 */
699struct platform_device __init *omap_device_build_ss(const char *pdev_name, int pdev_id,
700 struct omap_hwmod **ohs, int oh_cnt,
701 void *pdata, int pdata_len,
702 struct omap_device_pm_latency *pm_lats,
703 int pm_lats_cnt, int is_early_device)
704{
705 int ret = -ENOMEM;
706 struct platform_device *pdev;
707 struct omap_device *od;
708
709 if (!ohs || oh_cnt == 0 || !pdev_name)
710 return ERR_PTR(-EINVAL);
711
712 if (!pdata && pdata_len > 0)
713 return ERR_PTR(-EINVAL);
714
715 pdev = platform_device_alloc(pdev_name, pdev_id);
716 if (!pdev) {
717 ret = -ENOMEM;
718 goto odbs_exit;
719 }
720
721 /* Set the dev_name early to allow dev_xxx in omap_device_alloc */
722 if (pdev->id != -1)
723 dev_set_name(&pdev->dev, "%s.%d", pdev->name, pdev->id);
724 else
725 dev_set_name(&pdev->dev, "%s", pdev->name);
726
727 od = omap_device_alloc(pdev, ohs, oh_cnt, pm_lats, pm_lats_cnt);
728 if (IS_ERR(od))
729 goto odbs_exit1;
730
731 ret = platform_device_add_data(pdev, pdata, pdata_len);
732 if (ret)
733 goto odbs_exit2;
734
735 if (is_early_device)
736 ret = omap_early_device_register(pdev);
737 else
738 ret = omap_device_register(pdev);
739 if (ret)
740 goto odbs_exit2;
741
742 return pdev;
743
744odbs_exit2:
745 omap_device_delete(od);
746odbs_exit1:
747 platform_device_put(pdev);
748odbs_exit:
749
750 pr_err("omap_device: %s: build failed (%d)\n", pdev_name, ret);
751
752 return ERR_PTR(ret);
753}
754
755/**
756 * omap_early_device_register - register an omap_device as an early platform
757 * device.
758 * @od: struct omap_device * to register
759 *
760 * Register the omap_device structure. This currently just calls
761 * platform_early_add_device() on the underlying platform_device.
762 * Returns 0 by default.
763 */
764static int __init omap_early_device_register(struct platform_device *pdev)
765{
766 struct platform_device *devices[1];
767
768 devices[0] = pdev;
769 early_platform_add_devices(devices, 1);
770 return 0;
771}
772
773#ifdef CONFIG_PM_RUNTIME
774static int _od_runtime_suspend(struct device *dev)
775{
776 struct platform_device *pdev = to_platform_device(dev);
777 int ret;
778
779 ret = pm_generic_runtime_suspend(dev);
780
781 if (!ret)
782 omap_device_idle(pdev);
783
784 return ret;
785}
786
787static int _od_runtime_idle(struct device *dev)
788{
789 return pm_generic_runtime_idle(dev);
790}
791
792static int _od_runtime_resume(struct device *dev)
793{
794 struct platform_device *pdev = to_platform_device(dev);
795
796 omap_device_enable(pdev);
797
798 return pm_generic_runtime_resume(dev);
799}
800#endif
801
802#ifdef CONFIG_SUSPEND
803static int _od_suspend_noirq(struct device *dev)
804{
805 struct platform_device *pdev = to_platform_device(dev);
806 struct omap_device *od = to_omap_device(pdev);
807 int ret;
808
809 /* Don't attempt late suspend on a driver that is not bound */
810 if (od->_driver_status != BUS_NOTIFY_BOUND_DRIVER)
811 return 0;
812
813 ret = pm_generic_suspend_noirq(dev);
814
815 if (!ret && !pm_runtime_status_suspended(dev)) {
816 if (pm_generic_runtime_suspend(dev) == 0) {
817 if (!(od->flags & OMAP_DEVICE_NO_IDLE_ON_SUSPEND))
818 omap_device_idle(pdev);
819 od->flags |= OMAP_DEVICE_SUSPENDED;
820 }
821 }
822
823 return ret;
824}
825
826static int _od_resume_noirq(struct device *dev)
827{
828 struct platform_device *pdev = to_platform_device(dev);
829 struct omap_device *od = to_omap_device(pdev);
830
831 if ((od->flags & OMAP_DEVICE_SUSPENDED) &&
832 !pm_runtime_status_suspended(dev)) {
833 od->flags &= ~OMAP_DEVICE_SUSPENDED;
834 if (!(od->flags & OMAP_DEVICE_NO_IDLE_ON_SUSPEND))
835 omap_device_enable(pdev);
836 pm_generic_runtime_resume(dev);
837 }
838
839 return pm_generic_resume_noirq(dev);
840}
841#else
842#define _od_suspend_noirq NULL
843#define _od_resume_noirq NULL
844#endif
845
846struct dev_pm_domain omap_device_pm_domain = {
847 .ops = {
848 SET_RUNTIME_PM_OPS(_od_runtime_suspend, _od_runtime_resume,
849 _od_runtime_idle)
850 USE_PLATFORM_PM_SLEEP_OPS
851 .suspend_noirq = _od_suspend_noirq,
852 .resume_noirq = _od_resume_noirq,
853 }
854};
855
856/**
857 * omap_device_register - register an omap_device with one omap_hwmod
858 * @od: struct omap_device * to register
859 *
860 * Register the omap_device structure. This currently just calls
861 * platform_device_register() on the underlying platform_device.
862 * Returns the return value of platform_device_register().
863 */
864int omap_device_register(struct platform_device *pdev)
865{
866 pr_debug("omap_device: %s: registering\n", pdev->name);
867
868 pdev->dev.pm_domain = &omap_device_pm_domain;
869 return platform_device_add(pdev);
870}
871
872
873/* Public functions for use by device drivers through struct platform_data */
874
875/**
876 * omap_device_enable - fully activate an omap_device
877 * @od: struct omap_device * to activate
878 *
879 * Do whatever is necessary for the hwmods underlying omap_device @od
880 * to be accessible and ready to operate. This generally involves
881 * enabling clocks, setting SYSCONFIG registers; and in the future may
882 * involve remuxing pins. Device drivers should call this function
883 * (through platform_data function pointers) where they would normally
884 * enable clocks, etc. Returns -EINVAL if called when the omap_device
885 * is already enabled, or passes along the return value of
886 * _omap_device_activate().
887 */
888int omap_device_enable(struct platform_device *pdev)
889{
890 int ret;
891 struct omap_device *od;
892
893 od = to_omap_device(pdev);
894
895 if (od->_state == OMAP_DEVICE_STATE_ENABLED) {
896 dev_warn(&pdev->dev,
897 "omap_device: %s() called from invalid state %d\n",
898 __func__, od->_state);
899 return -EINVAL;
900 }
901
902 /* Enable everything if we're enabling this device from scratch */
903 if (od->_state == OMAP_DEVICE_STATE_UNKNOWN)
904 od->pm_lat_level = od->pm_lats_cnt;
905
906 ret = _omap_device_activate(od, IGNORE_WAKEUP_LAT);
907
908 od->dev_wakeup_lat = 0;
909 od->_dev_wakeup_lat_limit = UINT_MAX;
910 od->_state = OMAP_DEVICE_STATE_ENABLED;
911
912 return ret;
913}
914
915/**
916 * omap_device_idle - idle an omap_device
917 * @od: struct omap_device * to idle
918 *
919 * Idle omap_device @od by calling as many .deactivate_func() entries
920 * in the omap_device's pm_lats table as is possible without exceeding
921 * the device's maximum wakeup latency limit, pm_lat_limit. Device
922 * drivers should call this function (through platform_data function
923 * pointers) where they would normally disable clocks after operations
924 * complete, etc.. Returns -EINVAL if the omap_device is not
925 * currently enabled, or passes along the return value of
926 * _omap_device_deactivate().
927 */
928int omap_device_idle(struct platform_device *pdev)
929{
930 int ret;
931 struct omap_device *od;
932
933 od = to_omap_device(pdev);
934
935 if (od->_state != OMAP_DEVICE_STATE_ENABLED) {
936 dev_warn(&pdev->dev,
937 "omap_device: %s() called from invalid state %d\n",
938 __func__, od->_state);
939 return -EINVAL;
940 }
941
942 ret = _omap_device_deactivate(od, USE_WAKEUP_LAT);
943
944 od->_state = OMAP_DEVICE_STATE_IDLE;
945
946 return ret;
947}
948
949/**
950 * omap_device_shutdown - shut down an omap_device
951 * @od: struct omap_device * to shut down
952 *
953 * Shut down omap_device @od by calling all .deactivate_func() entries
954 * in the omap_device's pm_lats table and then shutting down all of
955 * the underlying omap_hwmods. Used when a device is being "removed"
956 * or a device driver is being unloaded. Returns -EINVAL if the
957 * omap_device is not currently enabled or idle, or passes along the
958 * return value of _omap_device_deactivate().
959 */
960int omap_device_shutdown(struct platform_device *pdev)
961{
962 int ret, i;
963 struct omap_device *od;
964
965 od = to_omap_device(pdev);
966
967 if (od->_state != OMAP_DEVICE_STATE_ENABLED &&
968 od->_state != OMAP_DEVICE_STATE_IDLE) {
969 dev_warn(&pdev->dev,
970 "omap_device: %s() called from invalid state %d\n",
971 __func__, od->_state);
972 return -EINVAL;
973 }
974
975 ret = _omap_device_deactivate(od, IGNORE_WAKEUP_LAT);
976
977 for (i = 0; i < od->hwmods_cnt; i++)
978 omap_hwmod_shutdown(od->hwmods[i]);
979
980 od->_state = OMAP_DEVICE_STATE_SHUTDOWN;
981
982 return ret;
983}
984
985/**
986 * omap_device_assert_hardreset - set a device's hardreset line
987 * @pdev: struct platform_device * to reset
988 * @name: const char * name of the reset line
989 *
990 * Set the hardreset line identified by @name on the IP blocks
991 * associated with the hwmods backing the platform_device @pdev. All
992 * of the hwmods associated with @pdev must have the same hardreset
993 * line linked to them for this to work. Passes along the return value
994 * of omap_hwmod_assert_hardreset() in the event of any failure, or
995 * returns 0 upon success.
996 */
997int omap_device_assert_hardreset(struct platform_device *pdev, const char *name)
998{
999 struct omap_device *od = to_omap_device(pdev);
1000 int ret = 0;
1001 int i;
1002
1003 for (i = 0; i < od->hwmods_cnt; i++) {
1004 ret = omap_hwmod_assert_hardreset(od->hwmods[i], name);
1005 if (ret)
1006 break;
1007 }
1008
1009 return ret;
1010}
1011
1012/**
1013 * omap_device_deassert_hardreset - release a device's hardreset line
1014 * @pdev: struct platform_device * to reset
1015 * @name: const char * name of the reset line
1016 *
1017 * Release the hardreset line identified by @name on the IP blocks
1018 * associated with the hwmods backing the platform_device @pdev. All
1019 * of the hwmods associated with @pdev must have the same hardreset
1020 * line linked to them for this to work. Passes along the return
1021 * value of omap_hwmod_deassert_hardreset() in the event of any
1022 * failure, or returns 0 upon success.
1023 */
1024int omap_device_deassert_hardreset(struct platform_device *pdev,
1025 const char *name)
1026{
1027 struct omap_device *od = to_omap_device(pdev);
1028 int ret = 0;
1029 int i;
1030
1031 for (i = 0; i < od->hwmods_cnt; i++) {
1032 ret = omap_hwmod_deassert_hardreset(od->hwmods[i], name);
1033 if (ret)
1034 break;
1035 }
1036
1037 return ret;
1038}
1039
1040/**
1041 * omap_device_align_pm_lat - activate/deactivate device to match wakeup lat lim
1042 * @od: struct omap_device *
1043 *
1044 * When a device's maximum wakeup latency limit changes, call some of
1045 * the .activate_func or .deactivate_func function pointers in the
1046 * omap_device's pm_lats array to ensure that the device's maximum
1047 * wakeup latency is less than or equal to the new latency limit.
1048 * Intended to be called by OMAP PM code whenever a device's maximum
1049 * wakeup latency limit changes (e.g., via
1050 * omap_pm_set_dev_wakeup_lat()). Returns 0 if nothing needs to be
1051 * done (e.g., if the omap_device is not currently idle, or if the
1052 * wakeup latency is already current with the new limit) or passes
1053 * along the return value of _omap_device_deactivate() or
1054 * _omap_device_activate().
1055 */
1056int omap_device_align_pm_lat(struct platform_device *pdev,
1057 u32 new_wakeup_lat_limit)
1058{
1059 int ret = -EINVAL;
1060 struct omap_device *od;
1061
1062 od = to_omap_device(pdev);
1063
1064 if (new_wakeup_lat_limit == od->dev_wakeup_lat)
1065 return 0;
1066
1067 od->_dev_wakeup_lat_limit = new_wakeup_lat_limit;
1068
1069 if (od->_state != OMAP_DEVICE_STATE_IDLE)
1070 return 0;
1071 else if (new_wakeup_lat_limit > od->dev_wakeup_lat)
1072 ret = _omap_device_deactivate(od, USE_WAKEUP_LAT);
1073 else if (new_wakeup_lat_limit < od->dev_wakeup_lat)
1074 ret = _omap_device_activate(od, USE_WAKEUP_LAT);
1075
1076 return ret;
1077}
1078
1079/**
1080 * omap_device_get_pwrdm - return the powerdomain * associated with @od
1081 * @od: struct omap_device *
1082 *
1083 * Return the powerdomain associated with the first underlying
1084 * omap_hwmod for this omap_device. Intended for use by core OMAP PM
1085 * code. Returns NULL on error or a struct powerdomain * upon
1086 * success.
1087 */
1088struct powerdomain *omap_device_get_pwrdm(struct omap_device *od)
1089{
1090 /*
1091 * XXX Assumes that all omap_hwmod powerdomains are identical.
1092 * This may not necessarily be true. There should be a sanity
1093 * check in here to WARN() if any difference appears.
1094 */
1095 if (!od->hwmods_cnt)
1096 return NULL;
1097
1098 return omap_hwmod_get_pwrdm(od->hwmods[0]);
1099}
1100
1101/**
1102 * omap_device_get_mpu_rt_va - return the MPU's virtual addr for the hwmod base
1103 * @od: struct omap_device *
1104 *
1105 * Return the MPU's virtual address for the base of the hwmod, from
1106 * the ioremap() that the hwmod code does. Only valid if there is one
1107 * hwmod associated with this device. Returns NULL if there are zero
1108 * or more than one hwmods associated with this omap_device;
1109 * otherwise, passes along the return value from
1110 * omap_hwmod_get_mpu_rt_va().
1111 */
1112void __iomem *omap_device_get_rt_va(struct omap_device *od)
1113{
1114 if (od->hwmods_cnt != 1)
1115 return NULL;
1116
1117 return omap_hwmod_get_mpu_rt_va(od->hwmods[0]);
1118}
1119
1120/**
1121 * omap_device_get_by_hwmod_name() - convert a hwmod name to
1122 * device pointer.
1123 * @oh_name: name of the hwmod device
1124 *
1125 * Returns back a struct device * pointer associated with a hwmod
1126 * device represented by a hwmod_name
1127 */
1128struct device *omap_device_get_by_hwmod_name(const char *oh_name)
1129{
1130 struct omap_hwmod *oh;
1131
1132 if (!oh_name) {
1133 WARN(1, "%s: no hwmod name!\n", __func__);
1134 return ERR_PTR(-EINVAL);
1135 }
1136
1137 oh = omap_hwmod_lookup(oh_name);
1138 if (IS_ERR_OR_NULL(oh)) {
1139 WARN(1, "%s: no hwmod for %s\n", __func__,
1140 oh_name);
1141 return ERR_PTR(oh ? PTR_ERR(oh) : -ENODEV);
1142 }
1143 if (IS_ERR_OR_NULL(oh->od)) {
1144 WARN(1, "%s: no omap_device for %s\n", __func__,
1145 oh_name);
1146 return ERR_PTR(oh->od ? PTR_ERR(oh->od) : -ENODEV);
1147 }
1148
1149 if (IS_ERR_OR_NULL(oh->od->pdev))
1150 return ERR_PTR(oh->od->pdev ? PTR_ERR(oh->od->pdev) : -ENODEV);
1151
1152 return &oh->od->pdev->dev;
1153}
1154EXPORT_SYMBOL(omap_device_get_by_hwmod_name);
1155
1156/*
1157 * Public functions intended for use in omap_device_pm_latency
1158 * .activate_func and .deactivate_func function pointers
1159 */
1160
1161/**
1162 * omap_device_enable_hwmods - call omap_hwmod_enable() on all hwmods
1163 * @od: struct omap_device *od
1164 *
1165 * Enable all underlying hwmods. Returns 0.
1166 */
1167int omap_device_enable_hwmods(struct omap_device *od)
1168{
1169 int i;
1170
1171 for (i = 0; i < od->hwmods_cnt; i++)
1172 omap_hwmod_enable(od->hwmods[i]);
1173
1174 /* XXX pass along return value here? */
1175 return 0;
1176}
1177
1178/**
1179 * omap_device_idle_hwmods - call omap_hwmod_idle() on all hwmods
1180 * @od: struct omap_device *od
1181 *
1182 * Idle all underlying hwmods. Returns 0.
1183 */
1184int omap_device_idle_hwmods(struct omap_device *od)
1185{
1186 int i;
1187
1188 for (i = 0; i < od->hwmods_cnt; i++)
1189 omap_hwmod_idle(od->hwmods[i]);
1190
1191 /* XXX pass along return value here? */
1192 return 0;
1193}
1194
1195/**
1196 * omap_device_disable_clocks - disable all main and interface clocks
1197 * @od: struct omap_device *od
1198 *
1199 * Disable the main functional clock and interface clock for all of the
1200 * omap_hwmods associated with the omap_device. Returns 0.
1201 */
1202int omap_device_disable_clocks(struct omap_device *od)
1203{
1204 int i;
1205
1206 for (i = 0; i < od->hwmods_cnt; i++)
1207 omap_hwmod_disable_clocks(od->hwmods[i]);
1208
1209 /* XXX pass along return value here? */
1210 return 0;
1211}
1212
1213/**
1214 * omap_device_enable_clocks - enable all main and interface clocks
1215 * @od: struct omap_device *od
1216 *
1217 * Enable the main functional clock and interface clock for all of the
1218 * omap_hwmods associated with the omap_device. Returns 0.
1219 */
1220int omap_device_enable_clocks(struct omap_device *od)
1221{
1222 int i;
1223
1224 for (i = 0; i < od->hwmods_cnt; i++)
1225 omap_hwmod_enable_clocks(od->hwmods[i]);
1226
1227 /* XXX pass along return value here? */
1228 return 0;
1229}
1230
1231static struct notifier_block platform_nb = {
1232 .notifier_call = _omap_device_notifier_call,
1233};
1234
1235static int __init omap_device_init(void)
1236{
1237 bus_register_notifier(&platform_bus_type, &platform_nb);
1238 return 0;
1239}
1240core_initcall(omap_device_init);
1241
1242/**
1243 * omap_device_late_idle - idle devices without drivers
1244 * @dev: struct device * associated with omap_device
1245 * @data: unused
1246 *
1247 * Check the driver bound status of this device, and idle it
1248 * if there is no driver attached.
1249 */
1250static int __init omap_device_late_idle(struct device *dev, void *data)
1251{
1252 struct platform_device *pdev = to_platform_device(dev);
1253 struct omap_device *od = to_omap_device(pdev);
1254
1255 if (!od)
1256 return 0;
1257
1258 /*
1259 * If omap_device state is enabled, but has no driver bound,
1260 * idle it.
1261 */
1262 if (od->_driver_status != BUS_NOTIFY_BOUND_DRIVER) {
1263 if (od->_state == OMAP_DEVICE_STATE_ENABLED) {
1264 dev_warn(dev, "%s: enabled but no driver. Idling\n",
1265 __func__);
1266 omap_device_idle(pdev);
1267 }
1268 }
1269
1270 return 0;
1271}
1272
1273static int __init omap_device_late_init(void)
1274{
1275 bus_for_each_dev(&platform_bus_type, NULL, NULL, omap_device_late_idle);
1276 return 0;
1277}
1278late_initcall(omap_device_late_init);