clockdomain.c 28.4 KB
Newer Older
1
/*
2
 * OMAP2/3/4 clockdomain framework functions
3
 *
4 5
 * Copyright (C) 2008-2010 Texas Instruments, Inc.
 * Copyright (C) 2008-2010 Nokia Corporation
6 7
 *
 * Written by Paul Walmsley and Jouni Högander
8
 * Added OMAP4 specific support by Abhijit Pagare <abhijitpagare@ti.com>
9 10 11 12 13
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 */
14
#undef DEBUG
15 16 17 18 19 20 21 22

#include <linux/kernel.h>
#include <linux/device.h>
#include <linux/list.h>
#include <linux/errno.h>
#include <linux/delay.h>
#include <linux/clk.h>
#include <linux/limits.h>
23
#include <linux/err.h>
24 25 26 27 28

#include <linux/io.h>

#include <linux/bitops.h>

29
#include "prm2xxx_3xxx.h"
30
#include "prm-regbits-24xx.h"
31
#include "cm2xxx_3xxx.h"
32
#include "cm-regbits-24xx.h"
33 34
#include "cminst44xx.h"
#include "prcm44xx.h"
35

36
#include <plat/clock.h>
37
#include "powerdomain.h"
38
#include "clockdomain.h"
39
#include <plat/prcm.h>
40 41 42 43

/* clkdm_list contains all registered struct clockdomains */
static LIST_HEAD(clkdm_list);

44 45
/* array of clockdomain deps to be added/removed when clkdm in hwsup mode */
static struct clkdm_autodep *autodeps;
46

47
static struct clkdm_ops *arch_clkdm;
48 49 50

/* Private functions */

51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69
static struct clockdomain *_clkdm_lookup(const char *name)
{
	struct clockdomain *clkdm, *temp_clkdm;

	if (!name)
		return NULL;

	clkdm = NULL;

	list_for_each_entry(temp_clkdm, &clkdm_list, node) {
		if (!strcmp(name, temp_clkdm->name)) {
			clkdm = temp_clkdm;
			break;
		}
	}

	return clkdm;
}

70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108
/**
 * _clkdm_register - register a clockdomain
 * @clkdm: struct clockdomain * to register
 *
 * Adds a clockdomain to the internal clockdomain list.
 * Returns -EINVAL if given a null pointer, -EEXIST if a clockdomain is
 * already registered by the provided name, or 0 upon success.
 */
static int _clkdm_register(struct clockdomain *clkdm)
{
	struct powerdomain *pwrdm;

	if (!clkdm || !clkdm->name)
		return -EINVAL;

	if (!omap_chip_is(clkdm->omap_chip))
		return -EINVAL;

	pwrdm = pwrdm_lookup(clkdm->pwrdm.name);
	if (!pwrdm) {
		pr_err("clockdomain: %s: powerdomain %s does not exist\n",
			clkdm->name, clkdm->pwrdm.name);
		return -EINVAL;
	}
	clkdm->pwrdm.ptr = pwrdm;

	/* Verify that the clockdomain is not already registered */
	if (_clkdm_lookup(clkdm->name))
		return -EEXIST;

	list_add(&clkdm->node, &clkdm_list);

	pwrdm_add_clkdm(pwrdm, clkdm);

	pr_debug("clockdomain: registered %s\n", clkdm->name);

	return 0;
}

109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134
/* _clkdm_deps_lookup - look up the specified clockdomain in a clkdm list */
static struct clkdm_dep *_clkdm_deps_lookup(struct clockdomain *clkdm,
					    struct clkdm_dep *deps)
{
	struct clkdm_dep *cd;

	if (!clkdm || !deps || !omap_chip_is(clkdm->omap_chip))
		return ERR_PTR(-EINVAL);

	for (cd = deps; cd->clkdm_name; cd++) {
		if (!omap_chip_is(cd->omap_chip))
			continue;

		if (!cd->clkdm && cd->clkdm_name)
			cd->clkdm = _clkdm_lookup(cd->clkdm_name);

		if (cd->clkdm == clkdm)
			break;
	}

	if (!cd->clkdm_name)
		return ERR_PTR(-ENOENT);

	return cd;
}

135
/*
136 137
 * _autodep_lookup - resolve autodep clkdm names to clkdm pointers; store
 * @autodep: struct clkdm_autodep * to resolve
138
 *
139 140 141
 * Resolve autodep clockdomain names to clockdomain pointers via
 * clkdm_lookup() and store the pointers in the autodep structure.  An
 * "autodep" is a clockdomain sleep/wakeup dependency that is
142 143 144 145 146
 * automatically added and removed whenever clocks in the associated
 * clockdomain are enabled or disabled (respectively) when the
 * clockdomain is in hardware-supervised mode.	Meant to be called
 * once at clockdomain layer initialization, since these should remain
 * fixed for a particular architecture.  No return value.
147 148 149
 *
 * XXX autodeps are deprecated and should be removed at the earliest
 * opportunity
150
 */
151
static void _autodep_lookup(struct clkdm_autodep *autodep)
152
{
153
	struct clockdomain *clkdm;
154 155 156 157 158 159 160

	if (!autodep)
		return;

	if (!omap_chip_is(autodep->omap_chip))
		return;

161 162 163 164 165
	clkdm = clkdm_lookup(autodep->clkdm.name);
	if (!clkdm) {
		pr_err("clockdomain: autodeps: clockdomain %s does not exist\n",
			 autodep->clkdm.name);
		clkdm = ERR_PTR(-ENOENT);
166
	}
167
	autodep->clkdm.ptr = clkdm;
168 169 170 171 172 173 174 175 176
}

/*
 * _clkdm_add_autodeps - add auto sleepdeps/wkdeps to clkdm upon clock enable
 * @clkdm: struct clockdomain *
 *
 * Add the "autodep" sleep & wakeup dependencies to clockdomain 'clkdm'
 * in hardware-supervised mode.  Meant to be called from clock framework
 * when a clock inside clockdomain 'clkdm' is enabled.	No return value.
177 178 179
 *
 * XXX autodeps are deprecated and should be removed at the earliest
 * opportunity
180 181 182
 */
static void _clkdm_add_autodeps(struct clockdomain *clkdm)
{
183
	struct clkdm_autodep *autodep;
184

185 186 187
	if (!autodeps)
		return;

188 189
	for (autodep = autodeps; autodep->clkdm.ptr; autodep++) {
		if (IS_ERR(autodep->clkdm.ptr))
190 191
			continue;

192 193 194
		if (!omap_chip_is(autodep->omap_chip))
			continue;

195
		pr_debug("clockdomain: adding %s sleepdep/wkdep for "
196 197
			 "clkdm %s\n", autodep->clkdm.ptr->name,
			 clkdm->name);
198

199 200
		clkdm_add_sleepdep(clkdm, autodep->clkdm.ptr);
		clkdm_add_wkdep(clkdm, autodep->clkdm.ptr);
201 202 203 204 205 206 207 208 209 210
	}
}

/*
 * _clkdm_add_autodeps - remove auto sleepdeps/wkdeps from clkdm
 * @clkdm: struct clockdomain *
 *
 * Remove the "autodep" sleep & wakeup dependencies from clockdomain 'clkdm'
 * in hardware-supervised mode.  Meant to be called from clock framework
 * when a clock inside clockdomain 'clkdm' is disabled.  No return value.
211 212 213
 *
 * XXX autodeps are deprecated and should be removed at the earliest
 * opportunity
214 215 216
 */
static void _clkdm_del_autodeps(struct clockdomain *clkdm)
{
217
	struct clkdm_autodep *autodep;
218

219 220 221
	if (!autodeps)
		return;

222 223
	for (autodep = autodeps; autodep->clkdm.ptr; autodep++) {
		if (IS_ERR(autodep->clkdm.ptr))
224 225
			continue;

226 227 228
		if (!omap_chip_is(autodep->omap_chip))
			continue;

229
		pr_debug("clockdomain: removing %s sleepdep/wkdep for "
230 231
			 "clkdm %s\n", autodep->clkdm.ptr->name,
			 clkdm->name);
232

233 234
		clkdm_del_sleepdep(clkdm, autodep->clkdm.ptr);
		clkdm_del_wkdep(clkdm, autodep->clkdm.ptr);
235 236 237
	}
}

238 239
/**
 * _enable_hwsup - place a clockdomain into hardware-supervised idle
240 241
 * @clkdm: struct clockdomain *
 *
242 243 244 245 246 247 248 249 250
 * Place the clockdomain into hardware-supervised idle mode.  No return
 * value.
 *
 * XXX Should this return an error if the clockdomain does not support
 * hardware-supervised idle mode?
 */
static void _enable_hwsup(struct clockdomain *clkdm)
{
	if (cpu_is_omap24xx())
251 252
		omap2xxx_cm_clkdm_enable_hwsup(clkdm->pwrdm.ptr->prcm_offs,
					       clkdm->clktrctrl_mask);
253
	else if (cpu_is_omap34xx())
254 255
		omap3xxx_cm_clkdm_enable_hwsup(clkdm->pwrdm.ptr->prcm_offs,
					       clkdm->clktrctrl_mask);
256 257 258 259
	else if (cpu_is_omap44xx())
		return omap4_cminst_clkdm_enable_hwsup(clkdm->prcm_partition,
						       clkdm->cm_inst,
						       clkdm->clkdm_offs);
260 261 262 263 264 265 266 267 268 269 270 271 272
	else
		BUG();
}

/**
 * _disable_hwsup - place a clockdomain into software-supervised idle
 * @clkdm: struct clockdomain *
 *
 * Place the clockdomain @clkdm into software-supervised idle mode.
 * No return value.
 *
 * XXX Should this return an error if the clockdomain does not support
 * software-supervised idle mode?
273
 */
274
static void _disable_hwsup(struct clockdomain *clkdm)
275
{
276
	if (cpu_is_omap24xx())
277 278
		omap2xxx_cm_clkdm_disable_hwsup(clkdm->pwrdm.ptr->prcm_offs,
						clkdm->clktrctrl_mask);
279
	else if (cpu_is_omap34xx())
280 281
		omap3xxx_cm_clkdm_disable_hwsup(clkdm->pwrdm.ptr->prcm_offs,
						clkdm->clktrctrl_mask);
282 283 284 285 286
	else if (cpu_is_omap44xx())
		return omap4_cminst_clkdm_disable_hwsup(clkdm->prcm_partition,
							clkdm->cm_inst,
							clkdm->clkdm_offs);
	else
287 288
		BUG();
}
289

290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315
/**
 * _resolve_clkdm_deps() - resolve clkdm_names in @clkdm_deps to clkdms
 * @clkdm: clockdomain that we are resolving dependencies for
 * @clkdm_deps: ptr to array of struct clkdm_deps to resolve
 *
 * Iterates through @clkdm_deps, looking up the struct clockdomain named by
 * clkdm_name and storing the clockdomain pointer in the struct clkdm_dep.
 * No return value.
 */
static void _resolve_clkdm_deps(struct clockdomain *clkdm,
				struct clkdm_dep *clkdm_deps)
{
	struct clkdm_dep *cd;

	for (cd = clkdm_deps; cd && cd->clkdm_name; cd++) {
		if (!omap_chip_is(cd->omap_chip))
			continue;
		if (cd->clkdm)
			continue;
		cd->clkdm = _clkdm_lookup(cd->clkdm_name);

		WARN(!cd->clkdm, "clockdomain: %s: could not find clkdm %s while resolving dependencies - should never happen",
		     clkdm->name, cd->clkdm_name);
	}
}

316 317 318 319 320 321
/* Public functions */

/**
 * clkdm_init - set up the clockdomain layer
 * @clkdms: optional pointer to an array of clockdomains to register
 * @init_autodeps: optional pointer to an array of autodeps to register
322
 * @custom_funcs: func pointers for arch specfic implementations
323 324
 *
 * Set up internal state.  If a pointer to an array of clockdomains
325 326 327 328
 * @clkdms was supplied, loop through the list of clockdomains,
 * register all that are available on the current platform. Similarly,
 * if a pointer to an array of clockdomain autodependencies
 * @init_autodeps was provided, register those.  No return value.
329 330
 */
void clkdm_init(struct clockdomain **clkdms,
331 332
		struct clkdm_autodep *init_autodeps,
		struct clkdm_ops *custom_funcs)
333 334
{
	struct clockdomain **c = NULL;
335
	struct clockdomain *clkdm;
336
	struct clkdm_autodep *autodep = NULL;
337

338 339 340 341 342
	if (!custom_funcs)
		WARN(1, "No custom clkdm functions registered\n");
	else
		arch_clkdm = custom_funcs;

343 344
	if (clkdms)
		for (c = clkdms; *c; c++)
345
			_clkdm_register(*c);
346

347 348 349 350
	autodeps = init_autodeps;
	if (autodeps)
		for (autodep = autodeps; autodep->clkdm.ptr; autodep++)
			_autodep_lookup(autodep);
351 352

	/*
353 354
	 * Put all clockdomains into software-supervised mode; PM code
	 * should later enable hardware-supervised mode as appropriate
355 356
	 */
	list_for_each_entry(clkdm, &clkdm_list, node) {
357
		if (clkdm->flags & CLKDM_CAN_FORCE_WAKEUP)
358
			clkdm_wakeup(clkdm);
359 360 361
		else if (clkdm->flags & CLKDM_CAN_DISABLE_AUTO)
			omap2_clkdm_deny_idle(clkdm);

362
		_resolve_clkdm_deps(clkdm, clkdm->wkdep_srcs);
363
		clkdm_clear_all_wkdeps(clkdm);
364 365

		_resolve_clkdm_deps(clkdm, clkdm->sleepdep_srcs);
366
		clkdm_clear_all_sleepdeps(clkdm);
367
	}
368 369 370 371 372 373
}

/**
 * clkdm_lookup - look up a clockdomain by name, return a pointer
 * @name: name of clockdomain
 *
374 375
 * Find a registered clockdomain by its name @name.  Returns a pointer
 * to the struct clockdomain if found, or NULL otherwise.
376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399
 */
struct clockdomain *clkdm_lookup(const char *name)
{
	struct clockdomain *clkdm, *temp_clkdm;

	if (!name)
		return NULL;

	clkdm = NULL;

	list_for_each_entry(temp_clkdm, &clkdm_list, node) {
		if (!strcmp(name, temp_clkdm->name)) {
			clkdm = temp_clkdm;
			break;
		}
	}

	return clkdm;
}

/**
 * clkdm_for_each - call function on each registered clockdomain
 * @fn: callback function *
 *
400 401
 * Call the supplied function @fn for each registered clockdomain.
 * The callback function @fn can return anything but 0 to bail
402 403 404 405 406 407 408 409
 * out early from the iterator.  The callback function is called with
 * the clkdm_mutex held, so no clockdomain structure manipulation
 * functions should be called from the callback, although hardware
 * clockdomain control functions are fine.  Returns the last return
 * value of the callback function, which should be 0 for success or
 * anything else to indicate failure; or -EINVAL if the function pointer
 * is null.
 */
410 411
int clkdm_for_each(int (*fn)(struct clockdomain *clkdm, void *user),
			void *user)
412 413 414 415 416 417 418 419
{
	struct clockdomain *clkdm;
	int ret = 0;

	if (!fn)
		return -EINVAL;

	list_for_each_entry(clkdm, &clkdm_list, node) {
420
		ret = (*fn)(clkdm, user);
421 422 423 424 425 426 427 428
		if (ret)
			break;
	}

	return ret;
}


429 430 431 432 433
/**
 * clkdm_get_pwrdm - return a ptr to the pwrdm that this clkdm resides in
 * @clkdm: struct clockdomain *
 *
 * Return a pointer to the struct powerdomain that the specified clockdomain
434
 * @clkdm exists in, or returns NULL if @clkdm is NULL.
435 436 437 438 439 440
 */
struct powerdomain *clkdm_get_pwrdm(struct clockdomain *clkdm)
{
	if (!clkdm)
		return NULL;

441
	return clkdm->pwrdm.ptr;
442 443 444
}


445 446
/* Hardware clockdomain control */

447 448 449 450 451 452 453 454 455 456 457 458 459 460 461
/**
 * clkdm_add_wkdep - add a wakeup dependency from clkdm2 to clkdm1
 * @clkdm1: wake this struct clockdomain * up (dependent)
 * @clkdm2: when this struct clockdomain * wakes up (source)
 *
 * When the clockdomain represented by @clkdm2 wakes up, wake up
 * @clkdm1. Implemented in hardware on the OMAP, this feature is
 * designed to reduce wakeup latency of the dependent clockdomain @clkdm1.
 * Returns -EINVAL if presented with invalid clockdomain pointers,
 * -ENOENT if @clkdm2 cannot wake up clkdm1 in hardware, or 0 upon
 * success.
 */
int clkdm_add_wkdep(struct clockdomain *clkdm1, struct clockdomain *clkdm2)
{
	struct clkdm_dep *cd;
462
	int ret = 0;
463

464 465 466 467 468 469
	if (!cpu_is_omap24xx() && !cpu_is_omap34xx()) {
		pr_err("clockdomain: %s/%s: %s: not yet implemented\n",
		       clkdm1->name, clkdm2->name, __func__);
		return -EINVAL;
	}

470 471 472 473
	if (!clkdm1 || !clkdm2)
		return -EINVAL;

	cd = _clkdm_deps_lookup(clkdm2, clkdm1->wkdep_srcs);
474 475 476 477 478 479 480
	if (IS_ERR(cd))
		ret = PTR_ERR(cd);

	if (!arch_clkdm || !arch_clkdm->clkdm_add_wkdep)
		ret = -EINVAL;

	if (ret) {
481 482
		pr_debug("clockdomain: hardware cannot set/clear wake up of "
			 "%s when %s wakes up\n", clkdm1->name, clkdm2->name);
483
		return ret;
484 485
	}

486 487 488
	if (atomic_inc_return(&cd->wkdep_usecount) == 1) {
		pr_debug("clockdomain: hardware will wake up %s when %s wakes "
			 "up\n", clkdm1->name, clkdm2->name);
489

490
		ret = arch_clkdm->clkdm_add_wkdep(clkdm1, clkdm2);
491
	}
492

493
	return ret;
494 495 496 497 498 499 500 501 502 503 504 505 506 507 508
}

/**
 * clkdm_del_wkdep - remove a wakeup dependency from clkdm2 to clkdm1
 * @clkdm1: wake this struct clockdomain * up (dependent)
 * @clkdm2: when this struct clockdomain * wakes up (source)
 *
 * Remove a wakeup dependency causing @clkdm1 to wake up when @clkdm2
 * wakes up.  Returns -EINVAL if presented with invalid clockdomain
 * pointers, -ENOENT if @clkdm2 cannot wake up clkdm1 in hardware, or
 * 0 upon success.
 */
int clkdm_del_wkdep(struct clockdomain *clkdm1, struct clockdomain *clkdm2)
{
	struct clkdm_dep *cd;
509
	int ret = 0;
510

511 512 513 514 515 516
	if (!cpu_is_omap24xx() && !cpu_is_omap34xx()) {
		pr_err("clockdomain: %s/%s: %s: not yet implemented\n",
		       clkdm1->name, clkdm2->name, __func__);
		return -EINVAL;
	}

517 518 519 520
	if (!clkdm1 || !clkdm2)
		return -EINVAL;

	cd = _clkdm_deps_lookup(clkdm2, clkdm1->wkdep_srcs);
521 522 523 524 525 526 527
	if (IS_ERR(cd))
		ret = PTR_ERR(cd);

	if (!arch_clkdm || !arch_clkdm->clkdm_del_wkdep)
		ret = -EINVAL;

	if (ret) {
528 529
		pr_debug("clockdomain: hardware cannot set/clear wake up of "
			 "%s when %s wakes up\n", clkdm1->name, clkdm2->name);
530
		return ret;
531 532
	}

533 534 535
	if (atomic_dec_return(&cd->wkdep_usecount) == 0) {
		pr_debug("clockdomain: hardware will no longer wake up %s "
			 "after %s wakes up\n", clkdm1->name, clkdm2->name);
536

537
		ret = arch_clkdm->clkdm_del_wkdep(clkdm1, clkdm2);
538
	}
539

540
	return ret;
541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559
}

/**
 * clkdm_read_wkdep - read wakeup dependency state from clkdm2 to clkdm1
 * @clkdm1: wake this struct clockdomain * up (dependent)
 * @clkdm2: when this struct clockdomain * wakes up (source)
 *
 * Return 1 if a hardware wakeup dependency exists wherein @clkdm1 will be
 * awoken when @clkdm2 wakes up; 0 if dependency is not set; -EINVAL
 * if either clockdomain pointer is invalid; or -ENOENT if the hardware
 * is incapable.
 *
 * REVISIT: Currently this function only represents software-controllable
 * wakeup dependencies.  Wakeup dependencies fixed in hardware are not
 * yet handled here.
 */
int clkdm_read_wkdep(struct clockdomain *clkdm1, struct clockdomain *clkdm2)
{
	struct clkdm_dep *cd;
560
	int ret = 0;
561 562 563 564

	if (!clkdm1 || !clkdm2)
		return -EINVAL;

565 566 567 568 569 570
	if (!cpu_is_omap24xx() && !cpu_is_omap34xx()) {
		pr_err("clockdomain: %s/%s: %s: not yet implemented\n",
		       clkdm1->name, clkdm2->name, __func__);
		return -EINVAL;
	}

571
	cd = _clkdm_deps_lookup(clkdm2, clkdm1->wkdep_srcs);
572 573 574 575 576 577 578
	if (IS_ERR(cd))
		ret = PTR_ERR(cd);

	if (!arch_clkdm || !arch_clkdm->clkdm_read_wkdep)
		ret = -EINVAL;

	if (ret) {
579 580
		pr_debug("clockdomain: hardware cannot set/clear wake up of "
			 "%s when %s wakes up\n", clkdm1->name, clkdm2->name);
581
		return ret;
582 583
	}

584
	/* XXX It's faster to return the atomic wkdep_usecount */
585
	return arch_clkdm->clkdm_read_wkdep(clkdm1, clkdm2);
586 587
}

588 589 590 591 592 593 594 595 596 597 598 599
/**
 * clkdm_clear_all_wkdeps - remove all wakeup dependencies from target clkdm
 * @clkdm: struct clockdomain * to remove all wakeup dependencies from
 *
 * Remove all inter-clockdomain wakeup dependencies that could cause
 * @clkdm to wake.  Intended to be used during boot to initialize the
 * PRCM to a known state, after all clockdomains are put into swsup idle
 * and woken up.  Returns -EINVAL if @clkdm pointer is invalid, or
 * 0 upon success.
 */
int clkdm_clear_all_wkdeps(struct clockdomain *clkdm)
{
600 601 602 603 604 605
	if (!cpu_is_omap24xx() && !cpu_is_omap34xx()) {
		pr_err("clockdomain: %s: %s: not yet implemented\n",
		       clkdm->name, __func__);
		return -EINVAL;
	}

606 607 608
	if (!clkdm)
		return -EINVAL;

609 610
	if (!arch_clkdm || !arch_clkdm->clkdm_clear_all_wkdeps)
		return -EINVAL;
611

612
	return arch_clkdm->clkdm_clear_all_wkdeps(clkdm);
613 614
}

615 616 617 618 619 620 621 622 623 624 625 626 627 628 629
/**
 * clkdm_add_sleepdep - add a sleep dependency from clkdm2 to clkdm1
 * @clkdm1: prevent this struct clockdomain * from sleeping (dependent)
 * @clkdm2: when this struct clockdomain * is active (source)
 *
 * Prevent @clkdm1 from automatically going inactive (and then to
 * retention or off) if @clkdm2 is active.  Returns -EINVAL if
 * presented with invalid clockdomain pointers or called on a machine
 * that does not support software-configurable hardware sleep
 * dependencies, -ENOENT if the specified dependency cannot be set in
 * hardware, or 0 upon success.
 */
int clkdm_add_sleepdep(struct clockdomain *clkdm1, struct clockdomain *clkdm2)
{
	struct clkdm_dep *cd;
630
	int ret = 0;
631 632 633 634 635

	if (!clkdm1 || !clkdm2)
		return -EINVAL;

	cd = _clkdm_deps_lookup(clkdm2, clkdm1->sleepdep_srcs);
636 637 638 639 640 641 642
	if (IS_ERR(cd))
		ret = PTR_ERR(cd);

	if (!arch_clkdm || !arch_clkdm->clkdm_add_sleepdep)
		ret = -EINVAL;

	if (ret) {
643 644 645
		pr_debug("clockdomain: hardware cannot set/clear sleep "
			 "dependency affecting %s from %s\n", clkdm1->name,
			 clkdm2->name);
646
		return ret;
647 648
	}

649 650 651
	if (atomic_inc_return(&cd->sleepdep_usecount) == 1) {
		pr_debug("clockdomain: will prevent %s from sleeping if %s "
			 "is active\n", clkdm1->name, clkdm2->name);
652

653
		ret = arch_clkdm->clkdm_add_sleepdep(clkdm1, clkdm2);
654
	}
655

656
	return ret;
657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673
}

/**
 * clkdm_del_sleepdep - remove a sleep dependency from clkdm2 to clkdm1
 * @clkdm1: prevent this struct clockdomain * from sleeping (dependent)
 * @clkdm2: when this struct clockdomain * is active (source)
 *
 * Allow @clkdm1 to automatically go inactive (and then to retention or
 * off), independent of the activity state of @clkdm2.  Returns -EINVAL
 * if presented with invalid clockdomain pointers or called on a machine
 * that does not support software-configurable hardware sleep dependencies,
 * -ENOENT if the specified dependency cannot be cleared in hardware, or
 * 0 upon success.
 */
int clkdm_del_sleepdep(struct clockdomain *clkdm1, struct clockdomain *clkdm2)
{
	struct clkdm_dep *cd;
674
	int ret = 0;
675 676 677 678 679

	if (!clkdm1 || !clkdm2)
		return -EINVAL;

	cd = _clkdm_deps_lookup(clkdm2, clkdm1->sleepdep_srcs);
680 681 682 683 684 685 686
	if (IS_ERR(cd))
		ret = PTR_ERR(cd);

	if (!arch_clkdm || !arch_clkdm->clkdm_del_sleepdep)
		ret = -EINVAL;

	if (ret) {
687 688 689
		pr_debug("clockdomain: hardware cannot set/clear sleep "
			 "dependency affecting %s from %s\n", clkdm1->name,
			 clkdm2->name);
690
		return ret;
691 692
	}

693 694 695 696
	if (atomic_dec_return(&cd->sleepdep_usecount) == 0) {
		pr_debug("clockdomain: will no longer prevent %s from "
			 "sleeping if %s is active\n", clkdm1->name,
			 clkdm2->name);
697

698
		ret = arch_clkdm->clkdm_del_sleepdep(clkdm1, clkdm2);
699
	}
700

701
	return ret;
702 703 704 705 706 707 708 709 710 711 712 713 714 715 716 717 718 719 720 721 722
}

/**
 * clkdm_read_sleepdep - read sleep dependency state from clkdm2 to clkdm1
 * @clkdm1: prevent this struct clockdomain * from sleeping (dependent)
 * @clkdm2: when this struct clockdomain * is active (source)
 *
 * Return 1 if a hardware sleep dependency exists wherein @clkdm1 will
 * not be allowed to automatically go inactive if @clkdm2 is active;
 * 0 if @clkdm1's automatic power state inactivity transition is independent
 * of @clkdm2's; -EINVAL if either clockdomain pointer is invalid or called
 * on a machine that does not support software-configurable hardware sleep
 * dependencies; or -ENOENT if the hardware is incapable.
 *
 * REVISIT: Currently this function only represents software-controllable
 * sleep dependencies.	Sleep dependencies fixed in hardware are not
 * yet handled here.
 */
int clkdm_read_sleepdep(struct clockdomain *clkdm1, struct clockdomain *clkdm2)
{
	struct clkdm_dep *cd;
723
	int ret = 0;
724 725 726 727 728

	if (!clkdm1 || !clkdm2)
		return -EINVAL;

	cd = _clkdm_deps_lookup(clkdm2, clkdm1->sleepdep_srcs);
729 730 731 732 733 734 735
	if (IS_ERR(cd))
		ret = PTR_ERR(cd);

	if (!arch_clkdm || !arch_clkdm->clkdm_read_sleepdep)
		ret = -EINVAL;

	if (ret) {
736 737 738
		pr_debug("clockdomain: hardware cannot set/clear sleep "
			 "dependency affecting %s from %s\n", clkdm1->name,
			 clkdm2->name);
739
		return ret;
740 741
	}

742
	/* XXX It's faster to return the atomic sleepdep_usecount */
743
	return arch_clkdm->clkdm_read_sleepdep(clkdm1, clkdm2);
744 745
}

746 747 748 749 750 751 752 753 754 755 756 757 758 759 760
/**
 * clkdm_clear_all_sleepdeps - remove all sleep dependencies from target clkdm
 * @clkdm: struct clockdomain * to remove all sleep dependencies from
 *
 * Remove all inter-clockdomain sleep dependencies that could prevent
 * @clkdm from idling.  Intended to be used during boot to initialize the
 * PRCM to a known state, after all clockdomains are put into swsup idle
 * and woken up.  Returns -EINVAL if @clkdm pointer is invalid, or
 * 0 upon success.
 */
int clkdm_clear_all_sleepdeps(struct clockdomain *clkdm)
{
	if (!clkdm)
		return -EINVAL;

761 762
	if (!arch_clkdm || !arch_clkdm->clkdm_clear_all_sleepdeps)
		return -EINVAL;
763

764
	return arch_clkdm->clkdm_clear_all_sleepdeps(clkdm);
765
}
766

767
/**
768
 * clkdm_sleep - force clockdomain sleep transition
769 770 771
 * @clkdm: struct clockdomain *
 *
 * Instruct the CM to force a sleep transition on the specified
772
 * clockdomain @clkdm.  Returns -EINVAL if @clkdm is NULL or if
773 774 775
 * clockdomain does not support software-initiated sleep; 0 upon
 * success.
 */
776
int clkdm_sleep(struct clockdomain *clkdm)
777 778 779 780 781 782 783 784 785 786
{
	if (!clkdm)
		return -EINVAL;

	if (!(clkdm->flags & CLKDM_CAN_FORCE_SLEEP)) {
		pr_debug("clockdomain: %s does not support forcing "
			 "sleep via software\n", clkdm->name);
		return -EINVAL;
	}

787 788
	if (!arch_clkdm || !arch_clkdm->clkdm_sleep)
		return -EINVAL;
789

790
	pr_debug("clockdomain: forcing sleep on %s\n", clkdm->name);
791

792
	return arch_clkdm->clkdm_sleep(clkdm);
793 794 795
}

/**
796
 * clkdm_wakeup - force clockdomain wakeup transition
797 798 799
 * @clkdm: struct clockdomain *
 *
 * Instruct the CM to force a wakeup transition on the specified
800
 * clockdomain @clkdm.  Returns -EINVAL if @clkdm is NULL or if the
801 802 803
 * clockdomain does not support software-controlled wakeup; 0 upon
 * success.
 */
804
int clkdm_wakeup(struct clockdomain *clkdm)
805 806 807 808 809 810 811 812 813 814
{
	if (!clkdm)
		return -EINVAL;

	if (!(clkdm->flags & CLKDM_CAN_FORCE_WAKEUP)) {
		pr_debug("clockdomain: %s does not support forcing "
			 "wakeup via software\n", clkdm->name);
		return -EINVAL;
	}

815 816
	if (!arch_clkdm || !arch_clkdm->clkdm_wakeup)
		return -EINVAL;
817

818
	pr_debug("clockdomain: forcing wakeup on %s\n", clkdm->name);
819

820
	return arch_clkdm->clkdm_wakeup(clkdm);
821 822 823 824 825 826
}

/**
 * omap2_clkdm_allow_idle - enable hwsup idle transitions for clkdm
 * @clkdm: struct clockdomain *
 *
827
 * Allow the hardware to automatically switch the clockdomain @clkdm into
828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845 846
 * active or idle states, as needed by downstream clocks.  If the
 * clockdomain has any downstream clocks enabled in the clock
 * framework, wkdep/sleepdep autodependencies are added; this is so
 * device drivers can read and write to the device.  No return value.
 */
void omap2_clkdm_allow_idle(struct clockdomain *clkdm)
{
	if (!clkdm)
		return;

	if (!(clkdm->flags & CLKDM_CAN_ENABLE_AUTO)) {
		pr_debug("clock: automatic idle transitions cannot be enabled "
			 "on clockdomain %s\n", clkdm->name);
		return;
	}

	pr_debug("clockdomain: enabling automatic idle transitions for %s\n",
		 clkdm->name);

847 848 849 850 851
	/*
	 * XXX This should be removed once TI adds wakeup/sleep
	 * dependency code and data for OMAP4.
	 */
	if (cpu_is_omap44xx()) {
852
		pr_err("clockdomain: %s: OMAP4 wakeup/sleep dependency support: not yet implemented\n", clkdm->name);
853 854 855 856
	} else {
		if (atomic_read(&clkdm->usecount) > 0)
			_clkdm_add_autodeps(clkdm);
	}
857

858
	_enable_hwsup(clkdm);
859 860

	pwrdm_clkdm_state_switch(clkdm);
861 862 863 864 865 866 867
}

/**
 * omap2_clkdm_deny_idle - disable hwsup idle transitions for clkdm
 * @clkdm: struct clockdomain *
 *
 * Prevent the hardware from automatically switching the clockdomain
868 869
 * @clkdm into inactive or idle states.  If the clockdomain has
 * downstream clocks enabled in the clock framework, wkdep/sleepdep
870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885
 * autodependencies are removed.  No return value.
 */
void omap2_clkdm_deny_idle(struct clockdomain *clkdm)
{
	if (!clkdm)
		return;

	if (!(clkdm->flags & CLKDM_CAN_DISABLE_AUTO)) {
		pr_debug("clockdomain: automatic idle transitions cannot be "
			 "disabled on %s\n", clkdm->name);
		return;
	}

	pr_debug("clockdomain: disabling automatic idle transitions for %s\n",
		 clkdm->name);

886
	_disable_hwsup(clkdm);
887

888 889 890 891 892
	/*
	 * XXX This should be removed once TI adds wakeup/sleep
	 * dependency code and data for OMAP4.
	 */
	if (cpu_is_omap44xx()) {
893
		pr_err("clockdomain: %s: OMAP4 wakeup/sleep dependency support: not yet implemented\n", clkdm->name);
894 895 896 897
	} else {
		if (atomic_read(&clkdm->usecount) > 0)
			_clkdm_del_autodeps(clkdm);
	}
898 899 900 901 902 903 904 905 906 907
}


/* Clockdomain-to-clock framework interface code */

/**
 * omap2_clkdm_clk_enable - add an enabled downstream clock to this clkdm
 * @clkdm: struct clockdomain *
 * @clk: struct clk * of the enabled downstream clock
 *
908 909 910 911 912 913 914 915
 * Increment the usecount of the clockdomain @clkdm and ensure that it
 * is awake before @clk is enabled.  Intended to be called by
 * clk_enable() code.  If the clockdomain is in software-supervised
 * idle mode, force the clockdomain to wake.  If the clockdomain is in
 * hardware-supervised idle mode, add clkdm-pwrdm autodependencies, to
 * ensure that devices in the clockdomain can be read from/written to
 * by on-chip processors.  Returns -EINVAL if passed null pointers;
 * returns 0 upon success or if the clockdomain is in hwsup idle mode.
916 917 918
 */
int omap2_clkdm_clk_enable(struct clockdomain *clkdm, struct clk *clk)
{
919
	bool hwsup = false;
920 921 922 923 924 925

	/*
	 * XXX Rewrite this code to maintain a list of enabled
	 * downstream clocks for debugging purposes?
	 */

926
	if (!clkdm || !clk)
927 928 929 930 931 932 933 934 935 936
		return -EINVAL;

	if (atomic_inc_return(&clkdm->usecount) > 1)
		return 0;

	/* Clockdomain now has one enabled downstream clock */

	pr_debug("clockdomain: clkdm %s: clk %s now enabled\n", clkdm->name,
		 clk->name);

937
	if (cpu_is_omap24xx() || cpu_is_omap34xx()) {
938

939 940 941 942 943 944 945 946 947 948 949
		if (!clkdm->clktrctrl_mask)
			return 0;

		hwsup = omap2_cm_is_clkdm_in_hwsup(clkdm->pwrdm.ptr->prcm_offs,
						   clkdm->clktrctrl_mask);

	} else if (cpu_is_omap44xx()) {

		hwsup = omap4_cminst_is_clkdm_in_hwsup(clkdm->prcm_partition,
						       clkdm->cm_inst,
						       clkdm->clkdm_offs);
950

951 952 953
	}

	if (hwsup) {
954
		/* Disable HW transitions when we are changing deps */
955
		_disable_hwsup(clkdm);
956
		_clkdm_add_autodeps(clkdm);
957
		_enable_hwsup(clkdm);
958
	} else {
959
		clkdm_wakeup(clkdm);
960
	}
961

962
	pwrdm_wait_transition(clkdm->pwrdm.ptr);
963
	pwrdm_clkdm_state_switch(clkdm);
964

965 966 967 968 969 970 971 972
	return 0;
}

/**
 * omap2_clkdm_clk_disable - remove an enabled downstream clock from this clkdm
 * @clkdm: struct clockdomain *
 * @clk: struct clk * of the disabled downstream clock
 *
973 974 975 976 977 978 979 980
 * Decrement the usecount of this clockdomain @clkdm when @clk is
 * disabled.  Intended to be called by clk_disable() code.  If the
 * clockdomain usecount goes to 0, put the clockdomain to sleep
 * (software-supervised mode) or remove the clkdm autodependencies
 * (hardware-supervised mode).  Returns -EINVAL if passed null
 * pointers; -ERANGE if the @clkdm usecount underflows and debugging
 * is enabled; or returns 0 upon success or if the clockdomain is in
 * hwsup idle mode.
981 982 983
 */
int omap2_clkdm_clk_disable(struct clockdomain *clkdm, struct clk *clk)
{
984
	bool hwsup = false;
985 986 987 988 989 990

	/*
	 * XXX Rewrite this code to maintain a list of enabled
	 * downstream clocks for debugging purposes?
	 */

991
	if (!clkdm || !clk)
992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008
		return -EINVAL;

#ifdef DEBUG
	if (atomic_read(&clkdm->usecount) == 0) {
		WARN_ON(1); /* underflow */
		return -ERANGE;
	}
#endif

	if (atomic_dec_return(&clkdm->usecount) > 0)
		return 0;

	/* All downstream clocks of this clockdomain are now disabled */

	pr_debug("clockdomain: clkdm %s: clk %s now disabled\n", clkdm->name,
		 clk->name);

1009 1010 1011 1012 1013 1014 1015
	if (cpu_is_omap24xx() || cpu_is_omap34xx()) {

		if (!clkdm->clktrctrl_mask)
			return 0;

		hwsup = omap2_cm_is_clkdm_in_hwsup(clkdm->pwrdm.ptr->prcm_offs,
						   clkdm->clktrctrl_mask);
1016

1017 1018 1019 1020 1021 1022 1023
	} else if (cpu_is_omap44xx()) {

		hwsup = omap4_cminst_is_clkdm_in_hwsup(clkdm->prcm_partition,
						       clkdm->cm_inst,
						       clkdm->clkdm_offs);

	}
1024

1025
	if (hwsup) {
1026
		/* Disable HW transitions when we are changing deps */
1027
		_disable_hwsup(clkdm);
1028
		_clkdm_del_autodeps(clkdm);
1029
		_enable_hwsup(clkdm);
1030
	} else {
1031
		clkdm_sleep(clkdm);
1032
	}
1033

1034 1035
	pwrdm_clkdm_state_switch(clkdm);

1036 1037 1038
	return 0;
}