xref: /openbmc/linux/arch/arm/mach-omap2/omap_hwmod.c (revision fd589a8f)
1 /*
2  * omap_hwmod implementation for OMAP2/3/4
3  *
4  * Copyright (C) 2009 Nokia Corporation
5  * Paul Walmsley
6  * With fixes and testing from Kevin Hilman
7  *
8  * Created in collaboration with (alphabetical order): Benoit Cousson,
9  * Kevin Hilman, Tony Lindgren, Rajendra Nayak, Vikram Pandita, Sakari
10  * Poussa, Anand Sawant, Santosh Shilimkar, Richard 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 manages "OMAP modules" (on-chip devices) and their
17  * integration with Linux device driver and bus code.
18  *
19  * References:
20  * - OMAP2420 Multimedia Processor Silicon Revision 2.1.1, 2.2 (SWPU064)
21  * - OMAP2430 Multimedia Device POP Silicon Revision 2.1 (SWPU090)
22  * - OMAP34xx Multimedia Device Silicon Revision 3.1 (SWPU108)
23  * - OMAP4430 Multimedia Device Silicon Revision 1.0 (SWPU140)
24  * - Open Core Protocol Specification 2.2
25  *
26  * To do:
27  * - pin mux handling
28  * - handle IO mapping
29  * - bus throughput & module latency measurement code
30  *
31  * XXX add tests at the beginning of each function to ensure the hwmod is
32  * in the appropriate state
33  * XXX error return values should be checked to ensure that they are
34  * appropriate
35  */
36 #undef DEBUG
37 
38 #include <linux/kernel.h>
39 #include <linux/errno.h>
40 #include <linux/io.h>
41 #include <linux/clk.h>
42 #include <linux/delay.h>
43 #include <linux/err.h>
44 #include <linux/list.h>
45 #include <linux/mutex.h>
46 #include <linux/bootmem.h>
47 
48 #include <mach/cpu.h>
49 #include <mach/clockdomain.h>
50 #include <mach/powerdomain.h>
51 #include <mach/clock.h>
52 #include <mach/omap_hwmod.h>
53 
54 #include "cm.h"
55 
56 /* Maximum microseconds to wait for OMAP module to reset */
57 #define MAX_MODULE_RESET_WAIT		10000
58 
59 /* Name of the OMAP hwmod for the MPU */
60 #define MPU_INITIATOR_NAME		"mpu_hwmod"
61 
62 /* omap_hwmod_list contains all registered struct omap_hwmods */
63 static LIST_HEAD(omap_hwmod_list);
64 
65 static DEFINE_MUTEX(omap_hwmod_mutex);
66 
67 /* mpu_oh: used to add/remove MPU initiator from sleepdep list */
68 static struct omap_hwmod *mpu_oh;
69 
70 /* inited: 0 if omap_hwmod_init() has not yet been called; 1 otherwise */
71 static u8 inited;
72 
73 
74 /* Private functions */
75 
76 /**
77  * _update_sysc_cache - return the module OCP_SYSCONFIG register, keep copy
78  * @oh: struct omap_hwmod *
79  *
80  * Load the current value of the hwmod OCP_SYSCONFIG register into the
81  * struct omap_hwmod for later use.  Returns -EINVAL if the hwmod has no
82  * OCP_SYSCONFIG register or 0 upon success.
83  */
84 static int _update_sysc_cache(struct omap_hwmod *oh)
85 {
86 	if (!oh->sysconfig) {
87 		WARN(!oh->sysconfig, "omap_hwmod: %s: cannot read "
88 		     "OCP_SYSCONFIG: not defined on hwmod\n", oh->name);
89 		return -EINVAL;
90 	}
91 
92 	/* XXX ensure module interface clock is up */
93 
94 	oh->_sysc_cache = omap_hwmod_readl(oh, oh->sysconfig->sysc_offs);
95 
96 	oh->_int_flags |= _HWMOD_SYSCONFIG_LOADED;
97 
98 	return 0;
99 }
100 
101 /**
102  * _write_sysconfig - write a value to the module's OCP_SYSCONFIG register
103  * @v: OCP_SYSCONFIG value to write
104  * @oh: struct omap_hwmod *
105  *
106  * Write @v into the module OCP_SYSCONFIG register, if it has one.  No
107  * return value.
108  */
109 static void _write_sysconfig(u32 v, struct omap_hwmod *oh)
110 {
111 	if (!oh->sysconfig) {
112 		WARN(!oh->sysconfig, "omap_hwmod: %s: cannot write "
113 		     "OCP_SYSCONFIG: not defined on hwmod\n", oh->name);
114 		return;
115 	}
116 
117 	/* XXX ensure module interface clock is up */
118 
119 	if (oh->_sysc_cache != v) {
120 		oh->_sysc_cache = v;
121 		omap_hwmod_writel(v, oh, oh->sysconfig->sysc_offs);
122 	}
123 }
124 
125 /**
126  * _set_master_standbymode: set the OCP_SYSCONFIG MIDLEMODE field in @v
127  * @oh: struct omap_hwmod *
128  * @standbymode: MIDLEMODE field bits
129  * @v: pointer to register contents to modify
130  *
131  * Update the master standby mode bits in @v to be @standbymode for
132  * the @oh hwmod.  Does not write to the hardware.  Returns -EINVAL
133  * upon error or 0 upon success.
134  */
135 static int _set_master_standbymode(struct omap_hwmod *oh, u8 standbymode,
136 				   u32 *v)
137 {
138 	if (!oh->sysconfig ||
139 	    !(oh->sysconfig->sysc_flags & SYSC_HAS_MIDLEMODE))
140 		return -EINVAL;
141 
142 	*v &= ~SYSC_MIDLEMODE_MASK;
143 	*v |= __ffs(standbymode) << SYSC_MIDLEMODE_SHIFT;
144 
145 	return 0;
146 }
147 
148 /**
149  * _set_slave_idlemode: set the OCP_SYSCONFIG SIDLEMODE field in @v
150  * @oh: struct omap_hwmod *
151  * @idlemode: SIDLEMODE field bits
152  * @v: pointer to register contents to modify
153  *
154  * Update the slave idle mode bits in @v to be @idlemode for the @oh
155  * hwmod.  Does not write to the hardware.  Returns -EINVAL upon error
156  * or 0 upon success.
157  */
158 static int _set_slave_idlemode(struct omap_hwmod *oh, u8 idlemode, u32 *v)
159 {
160 	if (!oh->sysconfig ||
161 	    !(oh->sysconfig->sysc_flags & SYSC_HAS_SIDLEMODE))
162 		return -EINVAL;
163 
164 	*v &= ~SYSC_SIDLEMODE_MASK;
165 	*v |= __ffs(idlemode) << SYSC_SIDLEMODE_SHIFT;
166 
167 	return 0;
168 }
169 
170 /**
171  * _set_clockactivity: set OCP_SYSCONFIG.CLOCKACTIVITY bits in @v
172  * @oh: struct omap_hwmod *
173  * @clockact: CLOCKACTIVITY field bits
174  * @v: pointer to register contents to modify
175  *
176  * Update the clockactivity mode bits in @v to be @clockact for the
177  * @oh hwmod.  Used for additional powersaving on some modules.  Does
178  * not write to the hardware.  Returns -EINVAL upon error or 0 upon
179  * success.
180  */
181 static int _set_clockactivity(struct omap_hwmod *oh, u8 clockact, u32 *v)
182 {
183 	if (!oh->sysconfig ||
184 	    !(oh->sysconfig->sysc_flags & SYSC_HAS_CLOCKACTIVITY))
185 		return -EINVAL;
186 
187 	*v &= ~SYSC_CLOCKACTIVITY_MASK;
188 	*v |= clockact << SYSC_CLOCKACTIVITY_SHIFT;
189 
190 	return 0;
191 }
192 
193 /**
194  * _set_softreset: set OCP_SYSCONFIG.CLOCKACTIVITY bits in @v
195  * @oh: struct omap_hwmod *
196  * @v: pointer to register contents to modify
197  *
198  * Set the SOFTRESET bit in @v for hwmod @oh.  Returns -EINVAL upon
199  * error or 0 upon success.
200  */
201 static int _set_softreset(struct omap_hwmod *oh, u32 *v)
202 {
203 	if (!oh->sysconfig ||
204 	    !(oh->sysconfig->sysc_flags & SYSC_HAS_SOFTRESET))
205 		return -EINVAL;
206 
207 	*v |= SYSC_SOFTRESET_MASK;
208 
209 	return 0;
210 }
211 
212 /**
213  * _enable_wakeup: set OCP_SYSCONFIG.ENAWAKEUP bit in the hardware
214  * @oh: struct omap_hwmod *
215  *
216  * Allow the hardware module @oh to send wakeups.  Returns -EINVAL
217  * upon error or 0 upon success.
218  */
219 static int _enable_wakeup(struct omap_hwmod *oh)
220 {
221 	u32 v;
222 
223 	if (!oh->sysconfig ||
224 	    !(oh->sysconfig->sysc_flags & SYSC_HAS_ENAWAKEUP))
225 		return -EINVAL;
226 
227 	v = oh->_sysc_cache;
228 	v |= SYSC_ENAWAKEUP_MASK;
229 	_write_sysconfig(v, oh);
230 
231 	/* XXX test pwrdm_get_wken for this hwmod's subsystem */
232 
233 	oh->_int_flags |= _HWMOD_WAKEUP_ENABLED;
234 
235 	return 0;
236 }
237 
238 /**
239  * _disable_wakeup: clear OCP_SYSCONFIG.ENAWAKEUP bit in the hardware
240  * @oh: struct omap_hwmod *
241  *
242  * Prevent the hardware module @oh to send wakeups.  Returns -EINVAL
243  * upon error or 0 upon success.
244  */
245 static int _disable_wakeup(struct omap_hwmod *oh)
246 {
247 	u32 v;
248 
249 	if (!oh->sysconfig ||
250 	    !(oh->sysconfig->sysc_flags & SYSC_HAS_ENAWAKEUP))
251 		return -EINVAL;
252 
253 	v = oh->_sysc_cache;
254 	v &= ~SYSC_ENAWAKEUP_MASK;
255 	_write_sysconfig(v, oh);
256 
257 	/* XXX test pwrdm_get_wken for this hwmod's subsystem */
258 
259 	oh->_int_flags &= ~_HWMOD_WAKEUP_ENABLED;
260 
261 	return 0;
262 }
263 
264 /**
265  * _add_initiator_dep: prevent @oh from smart-idling while @init_oh is active
266  * @oh: struct omap_hwmod *
267  *
268  * Prevent the hardware module @oh from entering idle while the
269  * hardare module initiator @init_oh is active.  Useful when a module
270  * will be accessed by a particular initiator (e.g., if a module will
271  * be accessed by the IVA, there should be a sleepdep between the IVA
272  * initiator and the module).  Only applies to modules in smart-idle
273  * mode.  Returns -EINVAL upon error or passes along
274  * pwrdm_add_sleepdep() value upon success.
275  */
276 static int _add_initiator_dep(struct omap_hwmod *oh, struct omap_hwmod *init_oh)
277 {
278 	if (!oh->_clk)
279 		return -EINVAL;
280 
281 	return pwrdm_add_sleepdep(oh->_clk->clkdm->pwrdm.ptr,
282 				  init_oh->_clk->clkdm->pwrdm.ptr);
283 }
284 
285 /**
286  * _del_initiator_dep: allow @oh to smart-idle even if @init_oh is active
287  * @oh: struct omap_hwmod *
288  *
289  * Allow the hardware module @oh to enter idle while the hardare
290  * module initiator @init_oh is active.  Useful when a module will not
291  * be accessed by a particular initiator (e.g., if a module will not
292  * be accessed by the IVA, there should be no sleepdep between the IVA
293  * initiator and the module).  Only applies to modules in smart-idle
294  * mode.  Returns -EINVAL upon error or passes along
295  * pwrdm_add_sleepdep() value upon success.
296  */
297 static int _del_initiator_dep(struct omap_hwmod *oh, struct omap_hwmod *init_oh)
298 {
299 	if (!oh->_clk)
300 		return -EINVAL;
301 
302 	return pwrdm_del_sleepdep(oh->_clk->clkdm->pwrdm.ptr,
303 				  init_oh->_clk->clkdm->pwrdm.ptr);
304 }
305 
306 /**
307  * _init_main_clk - get a struct clk * for the the hwmod's main functional clk
308  * @oh: struct omap_hwmod *
309  *
310  * Called from _init_clocks().  Populates the @oh _clk (main
311  * functional clock pointer) if a main_clk is present.  Returns 0 on
312  * success or -EINVAL on error.
313  */
314 static int _init_main_clk(struct omap_hwmod *oh)
315 {
316 	struct clk *c;
317 	int ret = 0;
318 
319 	if (!oh->clkdev_con_id)
320 		return 0;
321 
322 	c = clk_get_sys(oh->clkdev_dev_id, oh->clkdev_con_id);
323 	WARN(IS_ERR(c), "omap_hwmod: %s: cannot clk_get main_clk %s.%s\n",
324 	     oh->name, oh->clkdev_dev_id, oh->clkdev_con_id);
325 	if (IS_ERR(c))
326 		ret = -EINVAL;
327 	oh->_clk = c;
328 
329 	return ret;
330 }
331 
332 /**
333  * _init_interface_clk - get a struct clk * for the the hwmod's interface clks
334  * @oh: struct omap_hwmod *
335  *
336  * Called from _init_clocks().  Populates the @oh OCP slave interface
337  * clock pointers.  Returns 0 on success or -EINVAL on error.
338  */
339 static int _init_interface_clks(struct omap_hwmod *oh)
340 {
341 	struct omap_hwmod_ocp_if *os;
342 	struct clk *c;
343 	int i;
344 	int ret = 0;
345 
346 	if (oh->slaves_cnt == 0)
347 		return 0;
348 
349 	for (i = 0, os = *oh->slaves; i < oh->slaves_cnt; i++, os++) {
350 		if (!os->clkdev_con_id)
351 			continue;
352 
353 		c = clk_get_sys(os->clkdev_dev_id, os->clkdev_con_id);
354 		WARN(IS_ERR(c), "omap_hwmod: %s: cannot clk_get "
355 		     "interface_clk %s.%s\n", oh->name,
356 		     os->clkdev_dev_id, os->clkdev_con_id);
357 		if (IS_ERR(c))
358 			ret = -EINVAL;
359 		os->_clk = c;
360 	}
361 
362 	return ret;
363 }
364 
365 /**
366  * _init_opt_clk - get a struct clk * for the the hwmod's optional clocks
367  * @oh: struct omap_hwmod *
368  *
369  * Called from _init_clocks().  Populates the @oh omap_hwmod_opt_clk
370  * clock pointers.  Returns 0 on success or -EINVAL on error.
371  */
372 static int _init_opt_clks(struct omap_hwmod *oh)
373 {
374 	struct omap_hwmod_opt_clk *oc;
375 	struct clk *c;
376 	int i;
377 	int ret = 0;
378 
379 	for (i = oh->opt_clks_cnt, oc = oh->opt_clks; i > 0; i--, oc++) {
380 		c = clk_get_sys(oc->clkdev_dev_id, oc->clkdev_con_id);
381 		WARN(IS_ERR(c), "omap_hwmod: %s: cannot clk_get opt_clk "
382 		     "%s.%s\n", oh->name, oc->clkdev_dev_id,
383 		     oc->clkdev_con_id);
384 		if (IS_ERR(c))
385 			ret = -EINVAL;
386 		oc->_clk = c;
387 	}
388 
389 	return ret;
390 }
391 
392 /**
393  * _enable_clocks - enable hwmod main clock and interface clocks
394  * @oh: struct omap_hwmod *
395  *
396  * Enables all clocks necessary for register reads and writes to succeed
397  * on the hwmod @oh.  Returns 0.
398  */
399 static int _enable_clocks(struct omap_hwmod *oh)
400 {
401 	struct omap_hwmod_ocp_if *os;
402 	int i;
403 
404 	pr_debug("omap_hwmod: %s: enabling clocks\n", oh->name);
405 
406 	if (oh->_clk && !IS_ERR(oh->_clk))
407 		clk_enable(oh->_clk);
408 
409 	if (oh->slaves_cnt > 0) {
410 		for (i = 0, os = *oh->slaves; i < oh->slaves_cnt; i++, os++) {
411 			struct clk *c = os->_clk;
412 
413 			if (c && !IS_ERR(c) && (os->flags & OCPIF_SWSUP_IDLE))
414 				clk_enable(c);
415 		}
416 	}
417 
418 	/* The opt clocks are controlled by the device driver. */
419 
420 	return 0;
421 }
422 
423 /**
424  * _disable_clocks - disable hwmod main clock and interface clocks
425  * @oh: struct omap_hwmod *
426  *
427  * Disables the hwmod @oh main functional and interface clocks.  Returns 0.
428  */
429 static int _disable_clocks(struct omap_hwmod *oh)
430 {
431 	struct omap_hwmod_ocp_if *os;
432 	int i;
433 
434 	pr_debug("omap_hwmod: %s: disabling clocks\n", oh->name);
435 
436 	if (oh->_clk && !IS_ERR(oh->_clk))
437 		clk_disable(oh->_clk);
438 
439 	if (oh->slaves_cnt > 0) {
440 		for (i = 0, os = *oh->slaves; i < oh->slaves_cnt; i++, os++) {
441 			struct clk *c = os->_clk;
442 
443 			if (c && !IS_ERR(c) && (os->flags & OCPIF_SWSUP_IDLE))
444 				clk_disable(c);
445 		}
446 	}
447 
448 	/* The opt clocks are controlled by the device driver. */
449 
450 	return 0;
451 }
452 
453 /**
454  * _find_mpu_port_index - find hwmod OCP slave port ID intended for MPU use
455  * @oh: struct omap_hwmod *
456  *
457  * Returns the array index of the OCP slave port that the MPU
458  * addresses the device on, or -EINVAL upon error or not found.
459  */
460 static int _find_mpu_port_index(struct omap_hwmod *oh)
461 {
462 	struct omap_hwmod_ocp_if *os;
463 	int i;
464 	int found = 0;
465 
466 	if (!oh || oh->slaves_cnt == 0)
467 		return -EINVAL;
468 
469 	for (i = 0, os = *oh->slaves; i < oh->slaves_cnt; i++, os++) {
470 		if (os->user & OCP_USER_MPU) {
471 			found = 1;
472 			break;
473 		}
474 	}
475 
476 	if (found)
477 		pr_debug("omap_hwmod: %s: MPU OCP slave port ID  %d\n",
478 			 oh->name, i);
479 	else
480 		pr_debug("omap_hwmod: %s: no MPU OCP slave port found\n",
481 			 oh->name);
482 
483 	return (found) ? i : -EINVAL;
484 }
485 
486 /**
487  * _find_mpu_rt_base - find hwmod register target base addr accessible by MPU
488  * @oh: struct omap_hwmod *
489  *
490  * Return the virtual address of the base of the register target of
491  * device @oh, or NULL on error.
492  */
493 static void __iomem *_find_mpu_rt_base(struct omap_hwmod *oh, u8 index)
494 {
495 	struct omap_hwmod_ocp_if *os;
496 	struct omap_hwmod_addr_space *mem;
497 	int i;
498 	int found = 0;
499 
500 	if (!oh || oh->slaves_cnt == 0)
501 		return NULL;
502 
503 	os = *oh->slaves + index;
504 
505 	for (i = 0, mem = os->addr; i < os->addr_cnt; i++, mem++) {
506 		if (mem->flags & ADDR_TYPE_RT) {
507 			found = 1;
508 			break;
509 		}
510 	}
511 
512 	/* XXX use ioremap() instead? */
513 
514 	if (found)
515 		pr_debug("omap_hwmod: %s: MPU register target at va %p\n",
516 			 oh->name, OMAP2_IO_ADDRESS(mem->pa_start));
517 	else
518 		pr_debug("omap_hwmod: %s: no MPU register target found\n",
519 			 oh->name);
520 
521 	return (found) ? OMAP2_IO_ADDRESS(mem->pa_start) : NULL;
522 }
523 
524 /**
525  * _sysc_enable - try to bring a module out of idle via OCP_SYSCONFIG
526  * @oh: struct omap_hwmod *
527  *
528  * If module is marked as SWSUP_SIDLE, force the module out of slave
529  * idle; otherwise, configure it for smart-idle.  If module is marked
530  * as SWSUP_MSUSPEND, force the module out of master standby;
531  * otherwise, configure it for smart-standby.  No return value.
532  */
533 static void _sysc_enable(struct omap_hwmod *oh)
534 {
535 	u8 idlemode;
536 	u32 v;
537 
538 	if (!oh->sysconfig)
539 		return;
540 
541 	v = oh->_sysc_cache;
542 
543 	if (oh->sysconfig->sysc_flags & SYSC_HAS_SIDLEMODE) {
544 		idlemode = (oh->flags & HWMOD_SWSUP_SIDLE) ?
545 			HWMOD_IDLEMODE_NO : HWMOD_IDLEMODE_SMART;
546 		_set_slave_idlemode(oh, idlemode, &v);
547 	}
548 
549 	if (oh->sysconfig->sysc_flags & SYSC_HAS_MIDLEMODE) {
550 		idlemode = (oh->flags & HWMOD_SWSUP_MSTANDBY) ?
551 			HWMOD_IDLEMODE_NO : HWMOD_IDLEMODE_SMART;
552 		_set_master_standbymode(oh, idlemode, &v);
553 	}
554 
555 	/* XXX OCP AUTOIDLE bit? */
556 
557 	if (oh->flags & HWMOD_SET_DEFAULT_CLOCKACT &&
558 	    oh->sysconfig->sysc_flags & SYSC_HAS_CLOCKACTIVITY)
559 		_set_clockactivity(oh, oh->sysconfig->clockact, &v);
560 
561 	_write_sysconfig(v, oh);
562 }
563 
564 /**
565  * _sysc_idle - try to put a module into idle via OCP_SYSCONFIG
566  * @oh: struct omap_hwmod *
567  *
568  * If module is marked as SWSUP_SIDLE, force the module into slave
569  * idle; otherwise, configure it for smart-idle.  If module is marked
570  * as SWSUP_MSUSPEND, force the module into master standby; otherwise,
571  * configure it for smart-standby.  No return value.
572  */
573 static void _sysc_idle(struct omap_hwmod *oh)
574 {
575 	u8 idlemode;
576 	u32 v;
577 
578 	if (!oh->sysconfig)
579 		return;
580 
581 	v = oh->_sysc_cache;
582 
583 	if (oh->sysconfig->sysc_flags & SYSC_HAS_SIDLEMODE) {
584 		idlemode = (oh->flags & HWMOD_SWSUP_SIDLE) ?
585 			HWMOD_IDLEMODE_FORCE : HWMOD_IDLEMODE_SMART;
586 		_set_slave_idlemode(oh, idlemode, &v);
587 	}
588 
589 	if (oh->sysconfig->sysc_flags & SYSC_HAS_MIDLEMODE) {
590 		idlemode = (oh->flags & HWMOD_SWSUP_MSTANDBY) ?
591 			HWMOD_IDLEMODE_FORCE : HWMOD_IDLEMODE_SMART;
592 		_set_master_standbymode(oh, idlemode, &v);
593 	}
594 
595 	_write_sysconfig(v, oh);
596 }
597 
598 /**
599  * _sysc_shutdown - force a module into idle via OCP_SYSCONFIG
600  * @oh: struct omap_hwmod *
601  *
602  * Force the module into slave idle and master suspend. No return
603  * value.
604  */
605 static void _sysc_shutdown(struct omap_hwmod *oh)
606 {
607 	u32 v;
608 
609 	if (!oh->sysconfig)
610 		return;
611 
612 	v = oh->_sysc_cache;
613 
614 	if (oh->sysconfig->sysc_flags & SYSC_HAS_SIDLEMODE)
615 		_set_slave_idlemode(oh, HWMOD_IDLEMODE_FORCE, &v);
616 
617 	if (oh->sysconfig->sysc_flags & SYSC_HAS_MIDLEMODE)
618 		_set_master_standbymode(oh, HWMOD_IDLEMODE_FORCE, &v);
619 
620 	/* XXX clear OCP AUTOIDLE bit? */
621 
622 	_write_sysconfig(v, oh);
623 }
624 
625 /**
626  * _lookup - find an omap_hwmod by name
627  * @name: find an omap_hwmod by name
628  *
629  * Return a pointer to an omap_hwmod by name, or NULL if not found.
630  * Caller must hold omap_hwmod_mutex.
631  */
632 static struct omap_hwmod *_lookup(const char *name)
633 {
634 	struct omap_hwmod *oh, *temp_oh;
635 
636 	oh = NULL;
637 
638 	list_for_each_entry(temp_oh, &omap_hwmod_list, node) {
639 		if (!strcmp(name, temp_oh->name)) {
640 			oh = temp_oh;
641 			break;
642 		}
643 	}
644 
645 	return oh;
646 }
647 
648 /**
649  * _init_clocks - clk_get() all clocks associated with this hwmod
650  * @oh: struct omap_hwmod *
651  *
652  * Called by omap_hwmod_late_init() (after omap2_clk_init()).
653  * Resolves all clock names embedded in the hwmod.  Must be called
654  * with omap_hwmod_mutex held.  Returns -EINVAL if the omap_hwmod
655  * has not yet been registered or if the clocks have already been
656  * initialized, 0 on success, or a non-zero error on failure.
657  */
658 static int _init_clocks(struct omap_hwmod *oh)
659 {
660 	int ret = 0;
661 
662 	if (!oh || (oh->_state != _HWMOD_STATE_REGISTERED))
663 		return -EINVAL;
664 
665 	pr_debug("omap_hwmod: %s: looking up clocks\n", oh->name);
666 
667 	ret |= _init_main_clk(oh);
668 	ret |= _init_interface_clks(oh);
669 	ret |= _init_opt_clks(oh);
670 
671 	oh->_state = _HWMOD_STATE_CLKS_INITED;
672 
673 	return ret;
674 }
675 
676 /**
677  * _wait_target_ready - wait for a module to leave slave idle
678  * @oh: struct omap_hwmod *
679  *
680  * Wait for a module @oh to leave slave idle.  Returns 0 if the module
681  * does not have an IDLEST bit or if the module successfully leaves
682  * slave idle; otherwise, pass along the return value of the
683  * appropriate *_cm_wait_module_ready() function.
684  */
685 static int _wait_target_ready(struct omap_hwmod *oh)
686 {
687 	struct omap_hwmod_ocp_if *os;
688 	int ret;
689 
690 	if (!oh)
691 		return -EINVAL;
692 
693 	if (oh->_int_flags & _HWMOD_NO_MPU_PORT)
694 		return 0;
695 
696 	os = *oh->slaves + oh->_mpu_port_index;
697 
698 	if (!(os->flags & OCPIF_HAS_IDLEST))
699 		return 0;
700 
701 	/* XXX check module SIDLEMODE */
702 
703 	/* XXX check clock enable states */
704 
705 	if (cpu_is_omap24xx() || cpu_is_omap34xx()) {
706 		ret = omap2_cm_wait_module_ready(oh->prcm.omap2.module_offs,
707 						 oh->prcm.omap2.idlest_reg_id,
708 						 oh->prcm.omap2.idlest_idle_bit);
709 #if 0
710 	} else if (cpu_is_omap44xx()) {
711 		ret = omap4_cm_wait_module_ready(oh->prcm.omap4.module_offs,
712 						 oh->prcm.omap4.device_offs);
713 #endif
714 	} else {
715 		BUG();
716 	};
717 
718 	return ret;
719 }
720 
721 /**
722  * _reset - reset an omap_hwmod
723  * @oh: struct omap_hwmod *
724  *
725  * Resets an omap_hwmod @oh via the OCP_SYSCONFIG bit.  hwmod must be
726  * enabled for this to work.  Must be called with omap_hwmod_mutex
727  * held.  Returns -EINVAL if the hwmod cannot be reset this way or if
728  * the hwmod is in the wrong state, -ETIMEDOUT if the module did not
729  * reset in time, or 0 upon success.
730  */
731 static int _reset(struct omap_hwmod *oh)
732 {
733 	u32 r, v;
734 	int c;
735 
736 	if (!oh->sysconfig ||
737 	    !(oh->sysconfig->sysc_flags & SYSC_HAS_SOFTRESET) ||
738 	    (oh->sysconfig->sysc_flags & SYSS_MISSING))
739 		return -EINVAL;
740 
741 	/* clocks must be on for this operation */
742 	if (oh->_state != _HWMOD_STATE_ENABLED) {
743 		WARN(1, "omap_hwmod: %s: reset can only be entered from "
744 		     "enabled state\n", oh->name);
745 		return -EINVAL;
746 	}
747 
748 	pr_debug("omap_hwmod: %s: resetting\n", oh->name);
749 
750 	v = oh->_sysc_cache;
751 	r = _set_softreset(oh, &v);
752 	if (r)
753 		return r;
754 	_write_sysconfig(v, oh);
755 
756 	c = 0;
757 	while (c < MAX_MODULE_RESET_WAIT &&
758 	       !(omap_hwmod_readl(oh, oh->sysconfig->syss_offs) &
759 		 SYSS_RESETDONE_MASK)) {
760 		udelay(1);
761 		c++;
762 	}
763 
764 	if (c == MAX_MODULE_RESET_WAIT)
765 		WARN(1, "omap_hwmod: %s: failed to reset in %d usec\n",
766 		     oh->name, MAX_MODULE_RESET_WAIT);
767 	else
768 		pr_debug("omap_hwmod: %s: reset in %d usec\n", oh->name, c);
769 
770 	/*
771 	 * XXX add _HWMOD_STATE_WEDGED for modules that don't come back from
772 	 * _wait_target_ready() or _reset()
773 	 */
774 
775 	return (c == MAX_MODULE_RESET_WAIT) ? -ETIMEDOUT : 0;
776 }
777 
778 /**
779  * _enable - enable an omap_hwmod
780  * @oh: struct omap_hwmod *
781  *
782  * Enables an omap_hwmod @oh such that the MPU can access the hwmod's
783  * register target.  Must be called with omap_hwmod_mutex held.
784  * Returns -EINVAL if the hwmod is in the wrong state or passes along
785  * the return value of _wait_target_ready().
786  */
787 static int _enable(struct omap_hwmod *oh)
788 {
789 	int r;
790 
791 	if (oh->_state != _HWMOD_STATE_INITIALIZED &&
792 	    oh->_state != _HWMOD_STATE_IDLE &&
793 	    oh->_state != _HWMOD_STATE_DISABLED) {
794 		WARN(1, "omap_hwmod: %s: enabled state can only be entered "
795 		     "from initialized, idle, or disabled state\n", oh->name);
796 		return -EINVAL;
797 	}
798 
799 	pr_debug("omap_hwmod: %s: enabling\n", oh->name);
800 
801 	/* XXX mux balls */
802 
803 	_add_initiator_dep(oh, mpu_oh);
804 	_enable_clocks(oh);
805 
806 	if (oh->sysconfig) {
807 		if (!(oh->_int_flags & _HWMOD_SYSCONFIG_LOADED))
808 			_update_sysc_cache(oh);
809 		_sysc_enable(oh);
810 	}
811 
812 	r = _wait_target_ready(oh);
813 	if (!r)
814 		oh->_state = _HWMOD_STATE_ENABLED;
815 
816 	return r;
817 }
818 
819 /**
820  * _idle - idle an omap_hwmod
821  * @oh: struct omap_hwmod *
822  *
823  * Idles an omap_hwmod @oh.  This should be called once the hwmod has
824  * no further work.  Returns -EINVAL if the hwmod is in the wrong
825  * state or returns 0.
826  */
827 static int _idle(struct omap_hwmod *oh)
828 {
829 	if (oh->_state != _HWMOD_STATE_ENABLED) {
830 		WARN(1, "omap_hwmod: %s: idle state can only be entered from "
831 		     "enabled state\n", oh->name);
832 		return -EINVAL;
833 	}
834 
835 	pr_debug("omap_hwmod: %s: idling\n", oh->name);
836 
837 	if (oh->sysconfig)
838 		_sysc_idle(oh);
839 	_del_initiator_dep(oh, mpu_oh);
840 	_disable_clocks(oh);
841 
842 	oh->_state = _HWMOD_STATE_IDLE;
843 
844 	return 0;
845 }
846 
847 /**
848  * _shutdown - shutdown an omap_hwmod
849  * @oh: struct omap_hwmod *
850  *
851  * Shut down an omap_hwmod @oh.  This should be called when the driver
852  * used for the hwmod is removed or unloaded or if the driver is not
853  * used by the system.  Returns -EINVAL if the hwmod is in the wrong
854  * state or returns 0.
855  */
856 static int _shutdown(struct omap_hwmod *oh)
857 {
858 	if (oh->_state != _HWMOD_STATE_IDLE &&
859 	    oh->_state != _HWMOD_STATE_ENABLED) {
860 		WARN(1, "omap_hwmod: %s: disabled state can only be entered "
861 		     "from idle, or enabled state\n", oh->name);
862 		return -EINVAL;
863 	}
864 
865 	pr_debug("omap_hwmod: %s: disabling\n", oh->name);
866 
867 	if (oh->sysconfig)
868 		_sysc_shutdown(oh);
869 	_del_initiator_dep(oh, mpu_oh);
870 	/* XXX what about the other system initiators here? DMA, tesla, d2d */
871 	_disable_clocks(oh);
872 	/* XXX Should this code also force-disable the optional clocks? */
873 
874 	/* XXX mux any associated balls to safe mode */
875 
876 	oh->_state = _HWMOD_STATE_DISABLED;
877 
878 	return 0;
879 }
880 
881 /**
882  * _write_clockact_lock - set the module's clockactivity bits
883  * @oh: struct omap_hwmod *
884  * @clockact: CLOCKACTIVITY field bits
885  *
886  * Writes the CLOCKACTIVITY bits @clockact to the hwmod @oh
887  * OCP_SYSCONFIG register.  Returns -EINVAL if the hwmod is in the
888  * wrong state or returns 0.
889  */
890 static int _write_clockact_lock(struct omap_hwmod *oh, u8 clockact)
891 {
892 	u32 v;
893 
894 	if (!oh->sysconfig ||
895 	    !(oh->sysconfig->sysc_flags & SYSC_HAS_CLOCKACTIVITY))
896 		return -EINVAL;
897 
898 	mutex_lock(&omap_hwmod_mutex);
899 	v = oh->_sysc_cache;
900 	_set_clockactivity(oh, clockact, &v);
901 	_write_sysconfig(v, oh);
902 	mutex_unlock(&omap_hwmod_mutex);
903 
904 	return 0;
905 }
906 
907 
908 /**
909  * _setup - do initial configuration of omap_hwmod
910  * @oh: struct omap_hwmod *
911  *
912  * Writes the CLOCKACTIVITY bits @clockact to the hwmod @oh
913  * OCP_SYSCONFIG register.  Must be called with omap_hwmod_mutex
914  * held.  Returns -EINVAL if the hwmod is in the wrong state or returns
915  * 0.
916  */
917 static int _setup(struct omap_hwmod *oh)
918 {
919 	struct omap_hwmod_ocp_if *os;
920 	int i;
921 
922 	if (!oh)
923 		return -EINVAL;
924 
925 	/* Set iclk autoidle mode */
926 	if (oh->slaves_cnt > 0) {
927 		for (i = 0, os = *oh->slaves; i < oh->slaves_cnt; i++, os++) {
928 			struct clk *c = os->_clk;
929 
930 			if (!c || IS_ERR(c))
931 				continue;
932 
933 			if (os->flags & OCPIF_SWSUP_IDLE) {
934 				/* XXX omap_iclk_deny_idle(c); */
935 			} else {
936 				/* XXX omap_iclk_allow_idle(c); */
937 				clk_enable(c);
938 			}
939 		}
940 	}
941 
942 	oh->_state = _HWMOD_STATE_INITIALIZED;
943 
944 	_enable(oh);
945 
946 	if (!(oh->flags & HWMOD_INIT_NO_RESET))
947 		_reset(oh);
948 
949 	/* XXX OCP AUTOIDLE bit? */
950 	/* XXX OCP ENAWAKEUP bit? */
951 
952 	if (!(oh->flags & HWMOD_INIT_NO_IDLE))
953 		_idle(oh);
954 
955 	return 0;
956 }
957 
958 
959 
960 /* Public functions */
961 
962 u32 omap_hwmod_readl(struct omap_hwmod *oh, u16 reg_offs)
963 {
964 	return __raw_readl(oh->_rt_va + reg_offs);
965 }
966 
967 void omap_hwmod_writel(u32 v, struct omap_hwmod *oh, u16 reg_offs)
968 {
969 	__raw_writel(v, oh->_rt_va + reg_offs);
970 }
971 
972 /**
973  * omap_hwmod_register - register a struct omap_hwmod
974  * @oh: struct omap_hwmod *
975  *
976  * Registers the omap_hwmod @oh.  Returns -EEXIST if an omap_hwmod already
977  * has been registered by the same name; -EINVAL if the omap_hwmod is in the
978  * wrong state, or 0 on success.
979  *
980  * XXX The data should be copied into bootmem, so the original data
981  * should be marked __initdata and freed after init.  This would allow
982  * unneeded omap_hwmods to be freed on multi-OMAP configurations.  Note
983  * that the copy process would be relatively complex due to the large number
984  * of substructures.
985  */
986 int omap_hwmod_register(struct omap_hwmod *oh)
987 {
988 	int ret, ms_id;
989 
990 	if (!oh || (oh->_state != _HWMOD_STATE_UNKNOWN))
991 		return -EINVAL;
992 
993 	mutex_lock(&omap_hwmod_mutex);
994 
995 	pr_debug("omap_hwmod: %s: registering\n", oh->name);
996 
997 	if (_lookup(oh->name)) {
998 		ret = -EEXIST;
999 		goto ohr_unlock;
1000 	}
1001 
1002 	ms_id = _find_mpu_port_index(oh);
1003 	if (!IS_ERR_VALUE(ms_id)) {
1004 		oh->_mpu_port_index = ms_id;
1005 		oh->_rt_va = _find_mpu_rt_base(oh, oh->_mpu_port_index);
1006 	} else {
1007 		oh->_int_flags |= _HWMOD_NO_MPU_PORT;
1008 	}
1009 
1010 	list_add_tail(&oh->node, &omap_hwmod_list);
1011 
1012 	oh->_state = _HWMOD_STATE_REGISTERED;
1013 
1014 	ret = 0;
1015 
1016 ohr_unlock:
1017 	mutex_unlock(&omap_hwmod_mutex);
1018 	return ret;
1019 }
1020 
1021 /**
1022  * omap_hwmod_lookup - look up a registered omap_hwmod by name
1023  * @name: name of the omap_hwmod to look up
1024  *
1025  * Given a @name of an omap_hwmod, return a pointer to the registered
1026  * struct omap_hwmod *, or NULL upon error.
1027  */
1028 struct omap_hwmod *omap_hwmod_lookup(const char *name)
1029 {
1030 	struct omap_hwmod *oh;
1031 
1032 	if (!name)
1033 		return NULL;
1034 
1035 	mutex_lock(&omap_hwmod_mutex);
1036 	oh = _lookup(name);
1037 	mutex_unlock(&omap_hwmod_mutex);
1038 
1039 	return oh;
1040 }
1041 
1042 /**
1043  * omap_hwmod_for_each - call function for each registered omap_hwmod
1044  * @fn: pointer to a callback function
1045  *
1046  * Call @fn for each registered omap_hwmod, passing @data to each
1047  * function.  @fn must return 0 for success or any other value for
1048  * failure.  If @fn returns non-zero, the iteration across omap_hwmods
1049  * will stop and the non-zero return value will be passed to the
1050  * caller of omap_hwmod_for_each().  @fn is called with
1051  * omap_hwmod_for_each() held.
1052  */
1053 int omap_hwmod_for_each(int (*fn)(struct omap_hwmod *oh))
1054 {
1055 	struct omap_hwmod *temp_oh;
1056 	int ret;
1057 
1058 	if (!fn)
1059 		return -EINVAL;
1060 
1061 	mutex_lock(&omap_hwmod_mutex);
1062 	list_for_each_entry(temp_oh, &omap_hwmod_list, node) {
1063 		ret = (*fn)(temp_oh);
1064 		if (ret)
1065 			break;
1066 	}
1067 	mutex_unlock(&omap_hwmod_mutex);
1068 
1069 	return ret;
1070 }
1071 
1072 
1073 /**
1074  * omap_hwmod_init - init omap_hwmod code and register hwmods
1075  * @ohs: pointer to an array of omap_hwmods to register
1076  *
1077  * Intended to be called early in boot before the clock framework is
1078  * initialized.  If @ohs is not null, will register all omap_hwmods
1079  * listed in @ohs that are valid for this chip.  Returns -EINVAL if
1080  * omap_hwmod_init() has already been called or 0 otherwise.
1081  */
1082 int omap_hwmod_init(struct omap_hwmod **ohs)
1083 {
1084 	struct omap_hwmod *oh;
1085 	int r;
1086 
1087 	if (inited)
1088 		return -EINVAL;
1089 
1090 	inited = 1;
1091 
1092 	if (!ohs)
1093 		return 0;
1094 
1095 	oh = *ohs;
1096 	while (oh) {
1097 		if (omap_chip_is(oh->omap_chip)) {
1098 			r = omap_hwmod_register(oh);
1099 			WARN(r, "omap_hwmod: %s: omap_hwmod_register returned "
1100 			     "%d\n", oh->name, r);
1101 		}
1102 		oh = *++ohs;
1103 	}
1104 
1105 	return 0;
1106 }
1107 
1108 /**
1109  * omap_hwmod_late_init - do some post-clock framework initialization
1110  *
1111  * Must be called after omap2_clk_init().  Resolves the struct clk names
1112  * to struct clk pointers for each registered omap_hwmod.  Also calls
1113  * _setup() on each hwmod.  Returns 0.
1114  */
1115 int omap_hwmod_late_init(void)
1116 {
1117 	int r;
1118 
1119 	/* XXX check return value */
1120 	r = omap_hwmod_for_each(_init_clocks);
1121 	WARN(r, "omap_hwmod: omap_hwmod_late_init(): _init_clocks failed\n");
1122 
1123 	mpu_oh = omap_hwmod_lookup(MPU_INITIATOR_NAME);
1124 	WARN(!mpu_oh, "omap_hwmod: could not find MPU initiator hwmod %s\n",
1125 	     MPU_INITIATOR_NAME);
1126 
1127 	omap_hwmod_for_each(_setup);
1128 
1129 	return 0;
1130 }
1131 
1132 /**
1133  * omap_hwmod_unregister - unregister an omap_hwmod
1134  * @oh: struct omap_hwmod *
1135  *
1136  * Unregisters a previously-registered omap_hwmod @oh.  There's probably
1137  * no use case for this, so it is likely to be removed in a later version.
1138  *
1139  * XXX Free all of the bootmem-allocated structures here when that is
1140  * implemented.  Make it clear that core code is the only code that is
1141  * expected to unregister modules.
1142  */
1143 int omap_hwmod_unregister(struct omap_hwmod *oh)
1144 {
1145 	if (!oh)
1146 		return -EINVAL;
1147 
1148 	pr_debug("omap_hwmod: %s: unregistering\n", oh->name);
1149 
1150 	mutex_lock(&omap_hwmod_mutex);
1151 	list_del(&oh->node);
1152 	mutex_unlock(&omap_hwmod_mutex);
1153 
1154 	return 0;
1155 }
1156 
1157 /**
1158  * omap_hwmod_enable - enable an omap_hwmod
1159  * @oh: struct omap_hwmod *
1160  *
1161  * Enable an omap_hwomd @oh.  Intended to be called by omap_device_enable().
1162  * Returns -EINVAL on error or passes along the return value from _enable().
1163  */
1164 int omap_hwmod_enable(struct omap_hwmod *oh)
1165 {
1166 	int r;
1167 
1168 	if (!oh)
1169 		return -EINVAL;
1170 
1171 	mutex_lock(&omap_hwmod_mutex);
1172 	r = _enable(oh);
1173 	mutex_unlock(&omap_hwmod_mutex);
1174 
1175 	return r;
1176 }
1177 
1178 /**
1179  * omap_hwmod_idle - idle an omap_hwmod
1180  * @oh: struct omap_hwmod *
1181  *
1182  * Idle an omap_hwomd @oh.  Intended to be called by omap_device_idle().
1183  * Returns -EINVAL on error or passes along the return value from _idle().
1184  */
1185 int omap_hwmod_idle(struct omap_hwmod *oh)
1186 {
1187 	if (!oh)
1188 		return -EINVAL;
1189 
1190 	mutex_lock(&omap_hwmod_mutex);
1191 	_idle(oh);
1192 	mutex_unlock(&omap_hwmod_mutex);
1193 
1194 	return 0;
1195 }
1196 
1197 /**
1198  * omap_hwmod_shutdown - shutdown an omap_hwmod
1199  * @oh: struct omap_hwmod *
1200  *
1201  * Shutdown an omap_hwomd @oh.  Intended to be called by
1202  * omap_device_shutdown().  Returns -EINVAL on error or passes along
1203  * the return value from _shutdown().
1204  */
1205 int omap_hwmod_shutdown(struct omap_hwmod *oh)
1206 {
1207 	if (!oh)
1208 		return -EINVAL;
1209 
1210 	mutex_lock(&omap_hwmod_mutex);
1211 	_shutdown(oh);
1212 	mutex_unlock(&omap_hwmod_mutex);
1213 
1214 	return 0;
1215 }
1216 
1217 /**
1218  * omap_hwmod_enable_clocks - enable main_clk, all interface clocks
1219  * @oh: struct omap_hwmod *oh
1220  *
1221  * Intended to be called by the omap_device code.
1222  */
1223 int omap_hwmod_enable_clocks(struct omap_hwmod *oh)
1224 {
1225 	mutex_lock(&omap_hwmod_mutex);
1226 	_enable_clocks(oh);
1227 	mutex_unlock(&omap_hwmod_mutex);
1228 
1229 	return 0;
1230 }
1231 
1232 /**
1233  * omap_hwmod_disable_clocks - disable main_clk, all interface clocks
1234  * @oh: struct omap_hwmod *oh
1235  *
1236  * Intended to be called by the omap_device code.
1237  */
1238 int omap_hwmod_disable_clocks(struct omap_hwmod *oh)
1239 {
1240 	mutex_lock(&omap_hwmod_mutex);
1241 	_disable_clocks(oh);
1242 	mutex_unlock(&omap_hwmod_mutex);
1243 
1244 	return 0;
1245 }
1246 
1247 /**
1248  * omap_hwmod_ocp_barrier - wait for posted writes against the hwmod to complete
1249  * @oh: struct omap_hwmod *oh
1250  *
1251  * Intended to be called by drivers and core code when all posted
1252  * writes to a device must complete before continuing further
1253  * execution (for example, after clearing some device IRQSTATUS
1254  * register bits)
1255  *
1256  * XXX what about targets with multiple OCP threads?
1257  */
1258 void omap_hwmod_ocp_barrier(struct omap_hwmod *oh)
1259 {
1260 	BUG_ON(!oh);
1261 
1262 	if (!oh->sysconfig || !oh->sysconfig->sysc_flags) {
1263 		WARN(1, "omap_device: %s: OCP barrier impossible due to "
1264 		      "device configuration\n", oh->name);
1265 		return;
1266 	}
1267 
1268 	/*
1269 	 * Forces posted writes to complete on the OCP thread handling
1270 	 * register writes
1271 	 */
1272 	omap_hwmod_readl(oh, oh->sysconfig->sysc_offs);
1273 }
1274 
1275 /**
1276  * omap_hwmod_reset - reset the hwmod
1277  * @oh: struct omap_hwmod *
1278  *
1279  * Under some conditions, a driver may wish to reset the entire device.
1280  * Called from omap_device code.  Returns -EINVAL on error or passes along
1281  * the return value from _reset()/_enable().
1282  */
1283 int omap_hwmod_reset(struct omap_hwmod *oh)
1284 {
1285 	int r;
1286 
1287 	if (!oh || !(oh->_state & _HWMOD_STATE_ENABLED))
1288 		return -EINVAL;
1289 
1290 	mutex_lock(&omap_hwmod_mutex);
1291 	r = _reset(oh);
1292 	if (!r)
1293 		r = _enable(oh);
1294 	mutex_unlock(&omap_hwmod_mutex);
1295 
1296 	return r;
1297 }
1298 
1299 /**
1300  * omap_hwmod_count_resources - count number of struct resources needed by hwmod
1301  * @oh: struct omap_hwmod *
1302  * @res: pointer to the first element of an array of struct resource to fill
1303  *
1304  * Count the number of struct resource array elements necessary to
1305  * contain omap_hwmod @oh resources.  Intended to be called by code
1306  * that registers omap_devices.  Intended to be used to determine the
1307  * size of a dynamically-allocated struct resource array, before
1308  * calling omap_hwmod_fill_resources().  Returns the number of struct
1309  * resource array elements needed.
1310  *
1311  * XXX This code is not optimized.  It could attempt to merge adjacent
1312  * resource IDs.
1313  *
1314  */
1315 int omap_hwmod_count_resources(struct omap_hwmod *oh)
1316 {
1317 	int ret, i;
1318 
1319 	ret = oh->mpu_irqs_cnt + oh->sdma_chs_cnt;
1320 
1321 	for (i = 0; i < oh->slaves_cnt; i++)
1322 		ret += (*oh->slaves + i)->addr_cnt;
1323 
1324 	return ret;
1325 }
1326 
1327 /**
1328  * omap_hwmod_fill_resources - fill struct resource array with hwmod data
1329  * @oh: struct omap_hwmod *
1330  * @res: pointer to the first element of an array of struct resource to fill
1331  *
1332  * Fill the struct resource array @res with resource data from the
1333  * omap_hwmod @oh.  Intended to be called by code that registers
1334  * omap_devices.  See also omap_hwmod_count_resources().  Returns the
1335  * number of array elements filled.
1336  */
1337 int omap_hwmod_fill_resources(struct omap_hwmod *oh, struct resource *res)
1338 {
1339 	int i, j;
1340 	int r = 0;
1341 
1342 	/* For each IRQ, DMA, memory area, fill in array.*/
1343 
1344 	for (i = 0; i < oh->mpu_irqs_cnt; i++) {
1345 		(res + r)->start = *(oh->mpu_irqs + i);
1346 		(res + r)->end = *(oh->mpu_irqs + i);
1347 		(res + r)->flags = IORESOURCE_IRQ;
1348 		r++;
1349 	}
1350 
1351 	for (i = 0; i < oh->sdma_chs_cnt; i++) {
1352 		(res + r)->name = (oh->sdma_chs + i)->name;
1353 		(res + r)->start = (oh->sdma_chs + i)->dma_ch;
1354 		(res + r)->end = (oh->sdma_chs + i)->dma_ch;
1355 		(res + r)->flags = IORESOURCE_DMA;
1356 		r++;
1357 	}
1358 
1359 	for (i = 0; i < oh->slaves_cnt; i++) {
1360 		struct omap_hwmod_ocp_if *os;
1361 
1362 		os = *oh->slaves + i;
1363 
1364 		for (j = 0; j < os->addr_cnt; j++) {
1365 			(res + r)->start = (os->addr + j)->pa_start;
1366 			(res + r)->end = (os->addr + j)->pa_end;
1367 			(res + r)->flags = IORESOURCE_MEM;
1368 			r++;
1369 		}
1370 	}
1371 
1372 	return r;
1373 }
1374 
1375 /**
1376  * omap_hwmod_get_pwrdm - return pointer to this module's main powerdomain
1377  * @oh: struct omap_hwmod *
1378  *
1379  * Return the powerdomain pointer associated with the OMAP module
1380  * @oh's main clock.  If @oh does not have a main clk, return the
1381  * powerdomain associated with the interface clock associated with the
1382  * module's MPU port. (XXX Perhaps this should use the SDMA port
1383  * instead?)  Returns NULL on error, or a struct powerdomain * on
1384  * success.
1385  */
1386 struct powerdomain *omap_hwmod_get_pwrdm(struct omap_hwmod *oh)
1387 {
1388 	struct clk *c;
1389 
1390 	if (!oh)
1391 		return NULL;
1392 
1393 	if (oh->_clk) {
1394 		c = oh->_clk;
1395 	} else {
1396 		if (oh->_int_flags & _HWMOD_NO_MPU_PORT)
1397 			return NULL;
1398 		c = oh->slaves[oh->_mpu_port_index]->_clk;
1399 	}
1400 
1401 	return c->clkdm->pwrdm.ptr;
1402 
1403 }
1404 
1405 /**
1406  * omap_hwmod_add_initiator_dep - add sleepdep from @init_oh to @oh
1407  * @oh: struct omap_hwmod *
1408  * @init_oh: struct omap_hwmod * (initiator)
1409  *
1410  * Add a sleep dependency between the initiator @init_oh and @oh.
1411  * Intended to be called by DSP/Bridge code via platform_data for the
1412  * DSP case; and by the DMA code in the sDMA case.  DMA code, *Bridge
1413  * code needs to add/del initiator dependencies dynamically
1414  * before/after accessing a device.  Returns the return value from
1415  * _add_initiator_dep().
1416  *
1417  * XXX Keep a usecount in the clockdomain code
1418  */
1419 int omap_hwmod_add_initiator_dep(struct omap_hwmod *oh,
1420 				 struct omap_hwmod *init_oh)
1421 {
1422 	return _add_initiator_dep(oh, init_oh);
1423 }
1424 
1425 /*
1426  * XXX what about functions for drivers to save/restore ocp_sysconfig
1427  * for context save/restore operations?
1428  */
1429 
1430 /**
1431  * omap_hwmod_del_initiator_dep - remove sleepdep from @init_oh to @oh
1432  * @oh: struct omap_hwmod *
1433  * @init_oh: struct omap_hwmod * (initiator)
1434  *
1435  * Remove a sleep dependency between the initiator @init_oh and @oh.
1436  * Intended to be called by DSP/Bridge code via platform_data for the
1437  * DSP case; and by the DMA code in the sDMA case.  DMA code, *Bridge
1438  * code needs to add/del initiator dependencies dynamically
1439  * before/after accessing a device.  Returns the return value from
1440  * _del_initiator_dep().
1441  *
1442  * XXX Keep a usecount in the clockdomain code
1443  */
1444 int omap_hwmod_del_initiator_dep(struct omap_hwmod *oh,
1445 				 struct omap_hwmod *init_oh)
1446 {
1447 	return _del_initiator_dep(oh, init_oh);
1448 }
1449 
1450 /**
1451  * omap_hwmod_set_clockact_none - set clockactivity test to BOTH
1452  * @oh: struct omap_hwmod *
1453  *
1454  * On some modules, this function can affect the wakeup latency vs.
1455  * power consumption balance.  Intended to be called by the
1456  * omap_device layer.  Passes along the return value from
1457  * _write_clockact_lock().
1458  */
1459 int omap_hwmod_set_clockact_both(struct omap_hwmod *oh)
1460 {
1461 	return _write_clockact_lock(oh, CLOCKACT_TEST_BOTH);
1462 }
1463 
1464 /**
1465  * omap_hwmod_set_clockact_none - set clockactivity test to MAIN
1466  * @oh: struct omap_hwmod *
1467  *
1468  * On some modules, this function can affect the wakeup latency vs.
1469  * power consumption balance.  Intended to be called by the
1470  * omap_device layer.  Passes along the return value from
1471  * _write_clockact_lock().
1472  */
1473 int omap_hwmod_set_clockact_main(struct omap_hwmod *oh)
1474 {
1475 	return _write_clockact_lock(oh, CLOCKACT_TEST_MAIN);
1476 }
1477 
1478 /**
1479  * omap_hwmod_set_clockact_none - set clockactivity test to ICLK
1480  * @oh: struct omap_hwmod *
1481  *
1482  * On some modules, this function can affect the wakeup latency vs.
1483  * power consumption balance.  Intended to be called by the
1484  * omap_device layer.  Passes along the return value from
1485  * _write_clockact_lock().
1486  */
1487 int omap_hwmod_set_clockact_iclk(struct omap_hwmod *oh)
1488 {
1489 	return _write_clockact_lock(oh, CLOCKACT_TEST_ICLK);
1490 }
1491 
1492 /**
1493  * omap_hwmod_set_clockact_none - set clockactivity test to NONE
1494  * @oh: struct omap_hwmod *
1495  *
1496  * On some modules, this function can affect the wakeup latency vs.
1497  * power consumption balance.  Intended to be called by the
1498  * omap_device layer.  Passes along the return value from
1499  * _write_clockact_lock().
1500  */
1501 int omap_hwmod_set_clockact_none(struct omap_hwmod *oh)
1502 {
1503 	return _write_clockact_lock(oh, CLOCKACT_TEST_NONE);
1504 }
1505 
1506 /**
1507  * omap_hwmod_enable_wakeup - allow device to wake up the system
1508  * @oh: struct omap_hwmod *
1509  *
1510  * Sets the module OCP socket ENAWAKEUP bit to allow the module to
1511  * send wakeups to the PRCM.  Eventually this should sets PRCM wakeup
1512  * registers to cause the PRCM to receive wakeup events from the
1513  * module.  Does not set any wakeup routing registers beyond this
1514  * point - if the module is to wake up any other module or subsystem,
1515  * that must be set separately.  Called by omap_device code.  Returns
1516  * -EINVAL on error or 0 upon success.
1517  */
1518 int omap_hwmod_enable_wakeup(struct omap_hwmod *oh)
1519 {
1520 	if (!oh->sysconfig ||
1521 	    !(oh->sysconfig->sysc_flags & SYSC_HAS_ENAWAKEUP))
1522 		return -EINVAL;
1523 
1524 	mutex_lock(&omap_hwmod_mutex);
1525 	_enable_wakeup(oh);
1526 	mutex_unlock(&omap_hwmod_mutex);
1527 
1528 	return 0;
1529 }
1530 
1531 /**
1532  * omap_hwmod_disable_wakeup - prevent device from waking the system
1533  * @oh: struct omap_hwmod *
1534  *
1535  * Clears the module OCP socket ENAWAKEUP bit to prevent the module
1536  * from sending wakeups to the PRCM.  Eventually this should clear
1537  * PRCM wakeup registers to cause the PRCM to ignore wakeup events
1538  * from the module.  Does not set any wakeup routing registers beyond
1539  * this point - if the module is to wake up any other module or
1540  * subsystem, that must be set separately.  Called by omap_device
1541  * code.  Returns -EINVAL on error or 0 upon success.
1542  */
1543 int omap_hwmod_disable_wakeup(struct omap_hwmod *oh)
1544 {
1545 	if (!oh->sysconfig ||
1546 	    !(oh->sysconfig->sysc_flags & SYSC_HAS_ENAWAKEUP))
1547 		return -EINVAL;
1548 
1549 	mutex_lock(&omap_hwmod_mutex);
1550 	_disable_wakeup(oh);
1551 	mutex_unlock(&omap_hwmod_mutex);
1552 
1553 	return 0;
1554 }
1555