2 * OMAP4 powerdomain control
4 * Copyright (C) 2009-2010 Texas Instruments, Inc.
5 * Copyright (C) 2007-2009 Nokia Corporation
7 * Derived from mach-omap2/powerdomain.c written by Paul Walmsley
8 * Rajendra Nayak <rnayak@ti.com>
10 * This program is free software; you can redistribute it and/or modify
11 * it under the terms of the GNU General Public License version 2 as
12 * published by the Free Software Foundation.
16 #include <linux/errno.h>
17 #include <linux/delay.h>
18 #include <linux/bug.h>
20 #include "powerdomain.h"
21 #include <plat/prcm.h>
22 #include "prm2xxx_3xxx.h"
24 #include "prminst44xx.h"
25 #include "prm-regbits-44xx.h"
27 static int omap4_pwrdm_set_next_pwrst(struct powerdomain *pwrdm, u8 pwrst)
29 omap4_prminst_rmw_inst_reg_bits(OMAP_POWERSTATE_MASK,
30 (pwrst << OMAP_POWERSTATE_SHIFT),
31 pwrdm->prcm_partition,
32 pwrdm->prcm_offs, OMAP4_PM_PWSTCTRL);
36 static int omap4_pwrdm_read_next_pwrst(struct powerdomain *pwrdm)
40 v = omap4_prminst_read_inst_reg(pwrdm->prcm_partition, pwrdm->prcm_offs,
42 v &= OMAP_POWERSTATE_MASK;
43 v >>= OMAP_POWERSTATE_SHIFT;
48 static int omap4_pwrdm_read_pwrst(struct powerdomain *pwrdm)
52 v = omap4_prminst_read_inst_reg(pwrdm->prcm_partition, pwrdm->prcm_offs,
54 v &= OMAP_POWERSTATEST_MASK;
55 v >>= OMAP_POWERSTATEST_SHIFT;
60 static int omap4_pwrdm_read_prev_pwrst(struct powerdomain *pwrdm)
64 v = omap4_prminst_read_inst_reg(pwrdm->prcm_partition, pwrdm->prcm_offs,
66 v &= OMAP4430_LASTPOWERSTATEENTERED_MASK;
67 v >>= OMAP4430_LASTPOWERSTATEENTERED_SHIFT;
72 static int omap4_pwrdm_set_lowpwrstchange(struct powerdomain *pwrdm)
74 omap4_prminst_rmw_inst_reg_bits(OMAP4430_LOWPOWERSTATECHANGE_MASK,
75 (1 << OMAP4430_LOWPOWERSTATECHANGE_SHIFT),
76 pwrdm->prcm_partition,
77 pwrdm->prcm_offs, OMAP4_PM_PWSTCTRL);
81 static int omap4_pwrdm_clear_all_prev_pwrst(struct powerdomain *pwrdm)
83 omap4_prminst_rmw_inst_reg_bits(OMAP4430_LASTPOWERSTATEENTERED_MASK,
84 OMAP4430_LASTPOWERSTATEENTERED_MASK,
85 pwrdm->prcm_partition,
86 pwrdm->prcm_offs, OMAP4_PM_PWSTST);
90 static int omap4_pwrdm_set_logic_retst(struct powerdomain *pwrdm, u8 pwrst)
94 v = pwrst << __ffs(OMAP4430_LOGICRETSTATE_MASK);
95 omap4_prminst_rmw_inst_reg_bits(OMAP4430_LOGICRETSTATE_MASK, v,
96 pwrdm->prcm_partition, pwrdm->prcm_offs,
102 static int omap4_pwrdm_set_mem_onst(struct powerdomain *pwrdm, u8 bank,
107 m = omap2_pwrdm_get_mem_bank_onstate_mask(bank);
109 omap4_prminst_rmw_inst_reg_bits(m, (pwrst << __ffs(m)),
110 pwrdm->prcm_partition, pwrdm->prcm_offs,
116 static int omap4_pwrdm_set_mem_retst(struct powerdomain *pwrdm, u8 bank,
121 m = omap2_pwrdm_get_mem_bank_retst_mask(bank);
123 omap4_prminst_rmw_inst_reg_bits(m, (pwrst << __ffs(m)),
124 pwrdm->prcm_partition, pwrdm->prcm_offs,
130 static int omap4_pwrdm_read_logic_pwrst(struct powerdomain *pwrdm)
134 v = omap4_prminst_read_inst_reg(pwrdm->prcm_partition, pwrdm->prcm_offs,
136 v &= OMAP4430_LOGICSTATEST_MASK;
137 v >>= OMAP4430_LOGICSTATEST_SHIFT;
142 static int omap4_pwrdm_read_logic_retst(struct powerdomain *pwrdm)
146 v = omap4_prminst_read_inst_reg(pwrdm->prcm_partition, pwrdm->prcm_offs,
148 v &= OMAP4430_LOGICRETSTATE_MASK;
149 v >>= OMAP4430_LOGICRETSTATE_SHIFT;
154 static int omap4_pwrdm_read_mem_pwrst(struct powerdomain *pwrdm, u8 bank)
158 m = omap2_pwrdm_get_mem_bank_stst_mask(bank);
160 v = omap4_prminst_read_inst_reg(pwrdm->prcm_partition, pwrdm->prcm_offs,
168 static int omap4_pwrdm_read_mem_retst(struct powerdomain *pwrdm, u8 bank)
172 m = omap2_pwrdm_get_mem_bank_retst_mask(bank);
174 v = omap4_prminst_read_inst_reg(pwrdm->prcm_partition, pwrdm->prcm_offs,
182 static int omap4_pwrdm_wait_transition(struct powerdomain *pwrdm)
187 * REVISIT: pwrdm_wait_transition() may be better implemented
188 * via a callback and a periodic timer check -- how long do we expect
189 * powerdomain transitions to take?
192 /* XXX Is this udelay() value meaningful? */
193 while ((omap4_prminst_read_inst_reg(pwrdm->prcm_partition,
196 OMAP_INTRANSITION_MASK) &&
197 (c++ < PWRDM_TRANSITION_BAILOUT))
200 if (c > PWRDM_TRANSITION_BAILOUT) {
201 pr_err("powerdomain: %s: waited too long to complete transition\n",
206 pr_debug("powerdomain: completed transition in %d loops\n", c);
211 struct pwrdm_ops omap4_pwrdm_operations = {
212 .pwrdm_set_next_pwrst = omap4_pwrdm_set_next_pwrst,
213 .pwrdm_read_next_pwrst = omap4_pwrdm_read_next_pwrst,
214 .pwrdm_read_pwrst = omap4_pwrdm_read_pwrst,
215 .pwrdm_read_prev_pwrst = omap4_pwrdm_read_prev_pwrst,
216 .pwrdm_set_lowpwrstchange = omap4_pwrdm_set_lowpwrstchange,
217 .pwrdm_clear_all_prev_pwrst = omap4_pwrdm_clear_all_prev_pwrst,
218 .pwrdm_set_logic_retst = omap4_pwrdm_set_logic_retst,
219 .pwrdm_read_logic_pwrst = omap4_pwrdm_read_logic_pwrst,
220 .pwrdm_read_logic_retst = omap4_pwrdm_read_logic_retst,
221 .pwrdm_read_mem_pwrst = omap4_pwrdm_read_mem_pwrst,
222 .pwrdm_read_mem_retst = omap4_pwrdm_read_mem_retst,
223 .pwrdm_set_mem_onst = omap4_pwrdm_set_mem_onst,
224 .pwrdm_set_mem_retst = omap4_pwrdm_set_mem_retst,
225 .pwrdm_wait_transition = omap4_pwrdm_wait_transition,